diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp index 8659348d1b..7effec7a0d 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp @@ -41,7 +41,7 @@ void NavEKF3_core::controlMagYawReset() // check if the spin rate is OK - high spin rates can cause angular alignment errors bool angRateOK = deltaRotVecTemp.length() < 0.1745f; - initialResetAllowed = angRateOK; + initialResetAllowed = angRateOK && tiltAlignComplete; flightResetAllowed = angRateOK && !onGround; }