keep going people, nothing to see here
All checks were successful
EIVE/eive-obsw/pipeline/pr-main This commit looks good

This commit is contained in:
Marius Eggert 2023-07-20 13:09:49 +02:00
parent b26600ac64
commit 5f481fd4d0

View File

@ -9,9 +9,9 @@ void FusedRotationEstimation::estimateFusedRotationRateSafe(
acsctrl::GyrDataProcessed *gyrDataProcessed, acsctrl::FusedRotRateData *fusedRotRateData) { acsctrl::GyrDataProcessed *gyrDataProcessed, acsctrl::FusedRotRateData *fusedRotRateData) {
if ((not mgmDataProcessed->mgmVecTot.isValid()) or if ((not mgmDataProcessed->mgmVecTot.isValid()) or
(not susDataProcessed->susVecTot.isValid() and (not susDataProcessed->susVecTot.isValid() and
VectorOperations<double>::norm(fusedRotRateData->rotRateTotal.value, 3)) == 0 or not fusedRotRateData->rotRateTotal.isValid()) or
((VectorOperations<double>::norm(susDataProcessed->susVecTotDerivative.value, 3) == 0 and (not susDataProcessed->susVecTotDerivative.isValid() and
VectorOperations<double>::norm(mgmDataProcessed->mgmVecTotDerivative.value, 3) == 0))) { not mgmDataProcessed->mgmVecTotDerivative.isValid())) {
{ {
PoolReadGuard pg(fusedRotRateData); PoolReadGuard pg(fusedRotRateData);
std::memcpy(fusedRotRateData->rotRateOrthogonal.value, ZERO_VEC, 3 * sizeof(double)); std::memcpy(fusedRotRateData->rotRateOrthogonal.value, ZERO_VEC, 3 * sizeof(double));