diff --git a/libraries/AP_NavEKF/AP_NavEKF.cpp b/libraries/AP_NavEKF/AP_NavEKF.cpp index 3c5ce05dff..39ff5e2621 100644 --- a/libraries/AP_NavEKF/AP_NavEKF.cpp +++ b/libraries/AP_NavEKF/AP_NavEKF.cpp @@ -1988,6 +1988,8 @@ void NavEKF::FuseVelPosNED() decayGpsOffset(); // reset the position to the current GPS position which will include the glitch correction offset ResetPosition(); + // reset the velocity to the GPS velocity + ResetVelocity(); // don't fuse data on this time step fusePosData = false; }