diff --git a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp index de56b9e369..10c9074ade 100644 --- a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp +++ b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp @@ -81,9 +81,8 @@ void AP_AHRS_NavEKF::update(void) if (start_time_ms == 0) { start_time_ms = hal.scheduler->millis(); } - if (hal.scheduler->millis() - start_time_ms > startup_delay_ms && - EKF.InitialiseFilterDynamic()) { - ekf_started = true; + if (hal.scheduler->millis() - start_time_ms > startup_delay_ms) { + ekf_started = EKF.InitialiseFilterDynamic(); } } if (ekf_started) {