diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp index f907aefdf6..a0604b9d5c 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_Outputs.cpp @@ -345,6 +345,8 @@ bool NavEKF3_core::getLLH(struct Location &loc) const return true; } else { // if no GPS fix, provide last known position before entering the mode + loc.lat = EKF_origin.lat; + loc.lng = EKF_origin.lng; loc.offset(lastKnownPositionNE.x, lastKnownPositionNE.y); return false; }