private void disableEstimators(Axis currentAxis) { if (currentAxis != null) { List<OneDoFJointSensorValidityChecker> jointValidityCheckerList = jointValidityCheckers.get(currentAxis); for (int i = 0; i < jointValidityCheckerList.size(); i++) jointValidityCheckerList.get(i).disable(); } else { for (Axis axis : Axis.values) { List<OneDoFJointSensorValidityChecker> jointValidityCheckerList = jointValidityCheckers.get(axis); for (int i = 0; i < jointValidityCheckerList.size(); i++) jointValidityCheckerList.get(i).disable(); } } validityChecker.disable(); orientationVelocityConsistency.disable(); delayEstimator.disable(); velocityToOrientationQualityMeanCalculator.clear(); velocityToOrientationQualityStandardDeviationCalculator.clear(); velocityToOrientationDelayMeanCalculator.clear(); velocityToOrientationDelayStandardDeviationCalculator.clear(); velocityIMUVsJointQualityMeanCalculator.clear(); velocityIMUVsJointQualityStandardDeviationCalculator.clear(); velocityIMUVsJointDelayMeanCalculator.clear(); velocityIMUVsJointDelayStandardDeviationCalculator.clear(); }
private void disableEstimators(Direction currentDirection) { if (currentDirection != null) { List<OneDoFJointSensorValidityChecker> jointValidityCheckerList = jointValidityCheckers.get(currentDirection); for (int i = 0; i < jointValidityCheckerList.size(); i++) jointValidityCheckerList.get(i).disable(); } else { for (Direction direction : Direction.values) { List<OneDoFJointSensorValidityChecker> jointValidityCheckerList = jointValidityCheckers.get(direction); for (int i = 0; i < jointValidityCheckerList.size(); i++) jointValidityCheckerList.get(i).disable(); } } validityChecker.disable(); orientationVelocityConsistency.disable(); delayEstimator.disable(); velocityToOrientationQualityMeanCalculator.clear(); velocityToOrientationQualityStandardDeviationCalculator.clear(); velocityToOrientationDelayMeanCalculator.clear(); velocityToOrientationDelayStandardDeviationCalculator.clear(); velocityIMUVsJointQualityMeanCalculator.clear(); velocityIMUVsJointQualityStandardDeviationCalculator.clear(); velocityIMUVsJointDelayMeanCalculator.clear(); velocityIMUVsJointDelayStandardDeviationCalculator.clear(); }