aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_NavEKF3: use ekf_low_time_remaining for core scheduling

Browse Source
This commit is contained in:
Andrew Tridgell 2020-11-07 08:24:25 +11:00
parent 90a8c5cb1a
commit 31091d6307
1 changed files with 1 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
libraries/AP_NavEKF3/AP_NavEKF3.cpp
View File

@ -818,8 +818,7 @@ void NavEKF3::UpdateFilter(void)
// loop then suppress the prediction step. This allows
// multiple EKF instances to cooperate on scheduling
if (core[i].getFramesSincePredict() < (_framesPerPrediction+3) &&
// need sub-frame micros for this test
(AP::dal().micros64() - imuSampleTime_us) > _frameTimeUsec/3) {
AP::dal().ekf_low_time_remaining(AP_DAL::EKFType::EKF3, i)) {
statePredictEnabled[i] = false;
} else {
statePredictEnabled[i] = true;