Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF2: set origin on all cores

Browse Source 
when EKF origin is set, make sure it is set on all cores
This commit is contained in:
Andrew Tridgell 2019-07-27 15:29:15 +10:00 committed by Randy Mackay
parent 6e803a148e
commit beaaa5a7f5
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_NavEKF2/AP_NavEKF2.cpp
View File

@ -1034,7 +1034,12 @@ bool NavEKF2::setOriginLLH(const Location &loc)
if (!core) { if (!core) {
return false; return false;
} }
return core[primary].setOriginLLH(loc); bool ret = false;
for (uint8_t i=0; i<num_cores; i++) {
ret |= core[i].setOriginLLH(loc);
}
// return true if any core accepts the new origin
return ret;
} }
// return estimated height above ground level // return estimated height above ground level