ekf2: selector remove special timeout condition

- this mainly produces false positives when disarmed and bench testing
This commit is contained in:
Daniel Agar
2021-09-28 10:50:45 -04:00
parent ed7c5991eb
commit c39a21aa54
+1 -6
View File
@@ -251,12 +251,7 @@ bool EKF2Selector::UpdateErrorScores()
bool primary_updated = false;
// default estimator timeout
hrt_abstime status_timeout = 50_ms;
if (hrt_elapsed_time(&_attitude_last.timestamp) > FILTER_UPDATE_PERIOD) {
// much lower timeout if current primary estimator attitude isn't publishing
status_timeout = 2 * FILTER_UPDATE_PERIOD;
}
const hrt_abstime status_timeout = 50_ms;
// calculate individual error scores
for (uint8_t i = 0; i < EKF2_MAX_INSTANCES; i++) {