|
|
|
@ -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
|
|
|
|
|