diff --git a/mission/controller/AcsController.cpp b/mission/controller/AcsController.cpp index a7011502..08e8760d 100644 --- a/mission/controller/AcsController.cpp +++ b/mission/controller/AcsController.cpp @@ -323,18 +323,18 @@ void AcsController::performDetumble() { if (acsParameters.safeModeControllerParameters.useMekf) { if (mekfData.satRotRateMekf.isValid() and VectorOperations::norm(mekfData.satRotRateMekf.value, 3) < - acsParameters.detumbleParameter.omegaDetumbleStart) { + acsParameters.detumbleParameter.omegaDetumbleEnd) { detumbleCounter++; } } else if (acsParameters.safeModeControllerParameters.useGyr) { if (gyrDataProcessed.gyrVecTot.isValid() and VectorOperations::norm(gyrDataProcessed.gyrVecTot.value, 3) < - acsParameters.detumbleParameter.omegaDetumbleStart) { + acsParameters.detumbleParameter.omegaDetumbleEnd) { detumbleCounter++; } } else if (fusedRotRateData.rotRateTotal.isValid() and VectorOperations::norm(fusedRotRateData.rotRateTotal.value, 3) < - acsParameters.detumbleParameter.omegaDetumbleStart) { + acsParameters.detumbleParameter.omegaDetumbleEnd) { detumbleCounter++; } else if (detumbleCounter > 0) { detumbleCounter -= 1;