Always trigger Detumble #846
@@ -195,6 +195,8 @@ void AcsController::performAttitudeControl() {
|
|||||||
mekfInvalidFlag = false;
|
mekfInvalidFlag = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
handleDetumbling();
|
||||||
|
|
||||||
switch (mode) {
|
switch (mode) {
|
||||||
case acs::SAFE:
|
case acs::SAFE:
|
||||||
switch (submode) {
|
switch (submode) {
|
||||||
@@ -582,6 +584,7 @@ void AcsController::handleDetumbling() {
|
|||||||
// Triggers detumble mode transition in subsystem
|
// Triggers detumble mode transition in subsystem
|
||||||
triggerEvent(acs::SAFE_RATE_VIOLATION);
|
triggerEvent(acs::SAFE_RATE_VIOLATION);
|
||||||
startTransition(mode, acs::SafeSubmode::DETUMBLE);
|
startTransition(mode, acs::SafeSubmode::DETUMBLE);
|
||||||
|
detumbleState = DetumbleState::IN_DETUMBLE;
|
||||||
break;
|
break;
|
||||||
case DetumbleState::IN_DETUMBLE:
|
case DetumbleState::IN_DETUMBLE:
|
||||||
if (fusedRotRateData.rotRateTotal.isValid() and
|
if (fusedRotRateData.rotRateTotal.isValid() and
|
||||||
|
|||||||
@@ -601,7 +604,7 @@ void AcsController::handleDetumbling() {
|
|||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
sif::error << "AcsController: Invalid DetumbleState: " << detumbleState << std::endl;
|
sif::error << "AcsController: Invalid DetumbleState" << std::endl;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Reference in New Issue
Block a user
GYR and MEKF are not relevant anymore? (I just compared to the deleted code above..)
for now they are irrelevant. the MEKF might come back someday