quat is always valid even if it shouldn't be
Some checks are pending
EIVE/eive-obsw/pipeline/head Build started...

This commit is contained in:
Marius Eggert 2023-12-18 09:33:46 +01:00
parent e51dd33d82
commit 9089569b93
2 changed files with 8 additions and 4 deletions

View File

@ -380,8 +380,10 @@ void AcsController::performDetumble() {
} }
void AcsController::performPointingCtrl() { void AcsController::performPointingCtrl() {
bool strValid = (sensorValues.strSet.caliQw.isValid() and sensorValues.strSet.caliQx.isValid() and bool strValid =
sensorValues.strSet.caliQy.isValid() and sensorValues.strSet.caliQz.isValid()); ((sensorValues.strSet.caliQw.isValid() and sensorValues.strSet.caliQx.isValid() and
sensorValues.strSet.caliQy.isValid() and sensorValues.strSet.caliQz.isValid()) and
(sensorValues.strSet.isTrustWorthy.isValid() and sensorValues.strSet.isTrustWorthy.value));
uint8_t useMekf = false; uint8_t useMekf = false;
switch (mode) { switch (mode) {
case acs::PTG_IDLE: case acs::PTG_IDLE:

View File

@ -73,8 +73,10 @@ void FusedRotationEstimation::estimateFusedRotationRate(
void FusedRotationEstimation::estimateFusedRotationRateStr( void FusedRotationEstimation::estimateFusedRotationRateStr(
ACS::SensorValues *sensorValues, const double timeDelta, ACS::SensorValues *sensorValues, const double timeDelta,
acsctrl::FusedRotRateSourcesData *fusedRotRateSourcesData) { acsctrl::FusedRotRateSourcesData *fusedRotRateSourcesData) {
if (not(sensorValues->strSet.caliQw.isValid() and sensorValues->strSet.caliQx.isValid() and if (not((sensorValues->strSet.caliQw.isValid() and sensorValues->strSet.caliQx.isValid() and
sensorValues->strSet.caliQy.isValid() and sensorValues->strSet.caliQz.isValid())) { sensorValues->strSet.caliQy.isValid() and sensorValues->strSet.caliQz.isValid()) and
(sensorValues->strSet.isTrustWorthy.isValid() and
sensorValues->strSet.isTrustWorthy.value))) {
{ {
PoolReadGuard pg(fusedRotRateSourcesData); PoolReadGuard pg(fusedRotRateSourcesData);
if (pg.getReadResult() == returnvalue::OK) { if (pg.getReadResult() == returnvalue::OK) {