diff --git a/libraries/AP_NavEKF/AP_NavEKF.cpp b/libraries/AP_NavEKF/AP_NavEKF.cpp index 866be00435..04eeecdc36 100644 --- a/libraries/AP_NavEKF/AP_NavEKF.cpp +++ b/libraries/AP_NavEKF/AP_NavEKF.cpp @@ -720,7 +720,7 @@ void NavEKF::UpdateFilter() void NavEKF::SelectVelPosFusion() { // check for new data, specify which measurements should be used and check data for freshness - if (!constPosMode && !constVelMode) { + if (PV_AidingMode == AID_ABSOLUTE) { // check for and read new GPS data readGpsData();