|
|
|
@ -763,7 +763,7 @@ void NavEKF2::UpdateFilter(void)
@@ -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; |
|
|
|
|