Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-23 00:58:37 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF2: getLLH fix when no GPS available

Browse Source
This commit is contained in:
Randy Mackay 2020-04-24 15:02:19 +09:00
parent 70ef6cf02c
commit 2919491298
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF2/AP_NavEKF2_Outputs.cpp
View File

@ -349,6 +349,8 @@ bool NavEKF2_core::getLLH(struct Location &loc) const
} else {
// if no GPS fix, provide last known position before entering the mode
// correct for IMU offset (EKF calculations are at the IMU position)
loc.lat = EKF_origin.lat;
loc.lng = EKF_origin.lng;
loc.offset((lastKnownPositionNE.x + posOffsetNED.x), (lastKnownPositionNE.y + posOffsetNED.y));
return false;
}