diff --git a/src/modules/ekf_att_pos_estimator/estimator_23states.cpp b/src/modules/ekf_att_pos_estimator/estimator_23states.cpp index 1a2151017a..c122b3e51a 100644 --- a/src/modules/ekf_att_pos_estimator/estimator_23states.cpp +++ b/src/modules/ekf_att_pos_estimator/estimator_23states.cpp @@ -2390,6 +2390,8 @@ int AttPosEKF::CheckAndBound() ret = 5; } + // The excessive covariance detection already + // reset the filter. Just need to report here. if (current_ekf_state.covariancesExcessive) { FillErrorReport(&last_ekf_error); current_ekf_state.covariancesExcessive = false;