some fixes
This commit is contained in:
parent
c67f65369c
commit
3441365c65
@ -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;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user