Browse Source

AP_NavEKF3: set origin on all cores

when EKF origin is set, make sure it is set on all cores
master
Andrew Tridgell 6 years ago
parent
commit
a3411efdb5
  1. 7
      libraries/AP_NavEKF3/AP_NavEKF3.cpp

7
libraries/AP_NavEKF3/AP_NavEKF3.cpp

@ -1121,7 +1121,12 @@ bool NavEKF3::setOriginLLH(const Location &loc) @@ -1121,7 +1121,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

Loading…
Cancel
Save