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

AP_NavEKF3: 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
parent e9d51bb0c7
commit d43a386f83
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_NavEKF3/AP_NavEKF3.cpp
View File

@ -1053,7 +1053,12 @@ bool NavEKF3::setOriginLLH(const Location &loc)
if (!core) {
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