diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp index a02d2cbeba..0f695260a7 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_MagFusion.cpp @@ -127,6 +127,9 @@ void NavEKF3_core::controlMagYawReset() gcs().send_text(MAV_SEVERITY_WARNING, "EKF3 IMU%u ground mag anomaly, yaw re-aligned",(unsigned)imu_index); } + // prevent reset of variances in ConstrainVariances() + inhibitMagStates = false; + // update the yaw reset completed status recordYawReset();