This commit is contained in:
2023-03-15 10:06:24 +01:00
parent 4fdb2de510
commit ccf1fcaa79
2 changed files with 9 additions and 7 deletions

View File

@ -173,14 +173,16 @@ void AcsController::performSafe() {
sunTargetDir, satRateSafe, &errAng, magMomMtq);
}
if (result == returnvalue::FAILED) {
if (not doomFlag) {
if (not safeCtrlFailureFlag) {
triggerEvent(acs::SAFE_MODE_CONTROLLER_FAILURE);
doomFlag = true;
safeCtrlFailureFlag = true;
}
doomCounter++;
if (doomCounter > 5) {
doomFlag = false;
safeCtrlFailureCounter++;
if (safeCtrlFailureCounter > 50) {
safeCtrlFailureFlag = false;
}
} else {
safeCtrlFailureFlag = false;
}
actuatorCmd.cmdDipolMtq(magMomMtq, cmdDipolMtqs,