diff --git a/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp b/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp index bd7bd9f961..e0f19e58ce 100644 --- a/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp +++ b/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp @@ -465,6 +465,7 @@ void NavEKF3_core::InitialiseVariablesMag() magYawResetRequest = false; posDownAtLastMagReset = stateStruct.position.z; yawInnovAtLastMagReset = 0.0f; + stateStruct.quat.initialise(); quatAtLastMagReset = stateStruct.quat; magFieldLearned = false; storedMag.reset();