diff --git a/libraries/AP_NavEKF2/AP_NavEKF2.cpp b/libraries/AP_NavEKF2/AP_NavEKF2.cpp index feb7822dde..b960bc4a5b 100644 --- a/libraries/AP_NavEKF2/AP_NavEKF2.cpp +++ b/libraries/AP_NavEKF2/AP_NavEKF2.cpp @@ -763,7 +763,7 @@ void NavEKF2::UpdateFilter(void) // loop then suppress the prediction step. This allows // multiple EKF instances to cooperate on scheduling if (core[i].getFramesSincePredict() < (_framesPerPrediction+3) && - (AP::dal().micros64() - imuSampleTime_us) > _frameTimeUsec/3) { + AP::dal().ekf_low_time_remaining(AP_DAL::EKFType::EKF2, i)) { statePredictEnabled[i] = false; } else { statePredictEnabled[i] = true;