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

AP_NavEKF3: restrict setting of EKF origin

Browse Source 
only allow EKF origin to be set if EKx_GPS_TYPE is set to 3, which is
used for indoor operation
This commit is contained in:
Andrew Tridgell 2019-07-27 15:28:27 +10:00
parent a75e2e1c0e
commit 8ee28b4a66
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_NavEKF3/AP_NavEKF3.cpp
View File

@ -1043,6 +1043,13 @@ bool NavEKF3::getOriginLLH(int8_t instance, struct Location &loc) const
// Returns false if the filter has rejected the attempt to set the origin // Returns false if the filter has rejected the attempt to set the origin
bool NavEKF3::setOriginLLH(const Location &loc) bool NavEKF3::setOriginLLH(const Location &loc)
{ {
if (_fusionModeGPS != 3) {
// we don't allow setting of the EKF origin unless we are
// flying in non-GPS mode. This is to prevent accidental set
// of EKF origin with invalid position or height
gcs().send_text(MAV_SEVERITY_WARNING, "EKF3 refusing set origin");
return false;
}
if (!core) { if (!core) {
return false; return false;
} }