Prevent STR Blinding #859

Merged
meggert merged 35 commits from prevent-str-blinding into main 2024-02-27 13:48:20 +01:00
Showing only changes of commit 2e08f3b393 - Show all commits

View File

@ -1079,7 +1079,7 @@ ReturnValue_t MultiplicativeKalmanFilter::mekfEst(
MatrixOperations<double>::add(*cov0, *cov1, *initialCovarianceMatrix, 6, 6);
if (not(VectorOperations<double>::isFinite(propagatedQuaternion, 4)) ||
not(MatrixOperations<double>::isFinite(initialQuaternion, 6, 6))) {
not(MatrixOperations<double>::isFinite(*initialCovarianceMatrix, 6, 6))) {
updateDataSetWithoutData(mekfData, MekfStatus::NOT_FINITE);
return MEKF_NOT_FINITE;
}