From 5f481fd4d0b3832fd2f3efc067dabcd86de6281f Mon Sep 17 00:00:00 2001 From: meggert Date: Thu, 20 Jul 2023 13:09:49 +0200 Subject: [PATCH] keep going people, nothing to see here --- mission/controller/acs/FusedRotationEstimation.cpp | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/mission/controller/acs/FusedRotationEstimation.cpp b/mission/controller/acs/FusedRotationEstimation.cpp index 501d1913..bd84cb82 100644 --- a/mission/controller/acs/FusedRotationEstimation.cpp +++ b/mission/controller/acs/FusedRotationEstimation.cpp @@ -9,9 +9,9 @@ void FusedRotationEstimation::estimateFusedRotationRateSafe( acsctrl::GyrDataProcessed *gyrDataProcessed, acsctrl::FusedRotRateData *fusedRotRateData) { if ((not mgmDataProcessed->mgmVecTot.isValid()) or (not susDataProcessed->susVecTot.isValid() and - VectorOperations::norm(fusedRotRateData->rotRateTotal.value, 3)) == 0 or - ((VectorOperations::norm(susDataProcessed->susVecTotDerivative.value, 3) == 0 and - VectorOperations::norm(mgmDataProcessed->mgmVecTotDerivative.value, 3) == 0))) { + not fusedRotRateData->rotRateTotal.isValid()) or + (not susDataProcessed->susVecTotDerivative.isValid() and + not mgmDataProcessed->mgmVecTotDerivative.isValid())) { { PoolReadGuard pg(fusedRotRateData); std::memcpy(fusedRotRateData->rotRateOrthogonal.value, ZERO_VEC, 3 * sizeof(double));