diff --git a/libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp b/libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp index 8235a7b6b4..f929eb7f97 100644 --- a/libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp +++ b/libraries/AP_NavEKF2/AP_NavEKF2_Control.cpp @@ -143,10 +143,9 @@ void NavEKF2_core::setAidingMode() // reset the last valid position fix time to prevent unwanted activation of GPS glitch logic lastPosPassTime_ms = imuSampleTime_ms; } - // Reset all position, velocity and covariance + // Reset the position and velocity ResetVelocity(); ResetPosition(); - CovarianceInit(); }