Different Rot Rate Source for Detumble #902
@ -557,8 +557,8 @@ void AcsController::performPointingCtrl() {
|
|||||||
void AcsController::handleDetumbling() {
|
void AcsController::handleDetumbling() {
|
||||||
switch (detumbleState) {
|
switch (detumbleState) {
|
||||||
case DetumbleState::NO_DETUMBLE:
|
case DetumbleState::NO_DETUMBLE:
|
||||||
if (fusedRotRateSourcesData.rotRateTotalSusMgm.isValid() and
|
if (fusedRotRateData.rotRateTotalSusMgm.isValid() and
|
||||||
VectorOperations<double>::norm(fusedRotRateSourcesData.rotRateTotalSusMgm.value, 3) >
|
VectorOperations<double>::norm(fusedRotRateData.rotRateTotalSusMgm.value, 3) >
|
||||||
acsParameters.detumbleParameter.omegaDetumbleStart) {
|
acsParameters.detumbleParameter.omegaDetumbleStart) {
|
||||||
detumbleCounter++;
|
detumbleCounter++;
|
||||||
} else if (detumbleCounter > 0) {
|
} else if (detumbleCounter > 0) {
|
||||||
@ -601,8 +601,8 @@ void AcsController::handleDetumbling() {
|
|||||||
detumbleState = DetumbleState::NO_DETUMBLE;
|
detumbleState = DetumbleState::NO_DETUMBLE;
|
||||||
break;
|
break;
|
||||||
case DetumbleState::IN_DETUMBLE:
|
case DetumbleState::IN_DETUMBLE:
|
||||||
if (fusedRotRateSourcesData.rotRateTotalSusMgm.isValid() and
|
if (fusedRotRateData.rotRateTotalSusMgm.isValid() and
|
||||||
VectorOperations<double>::norm(fusedRotRateSourcesData.rotRateTotalSusMgm.value, 3) <
|
VectorOperations<double>::norm(fusedRotRateData.rotRateTotalSusMgm.value, 3) <
|
||||||
acsParameters.detumbleParameter.omegaDetumbleEnd) {
|
acsParameters.detumbleParameter.omegaDetumbleEnd) {
|
||||||
detumbleCounter++;
|
detumbleCounter++;
|
||||||
} else if (detumbleCounter > 0) {
|
} else if (detumbleCounter > 0) {
|
||||||
|
Loading…
Reference in New Issue
Block a user