diff --git a/src/modules/ekf2/EKF/aid_sources/magnetometer/mag_control.cpp b/src/modules/ekf2/EKF/aid_sources/magnetometer/mag_control.cpp index 8bf976b8fa..74d017add5 100644 --- a/src/modules/ekf2/EKF/aid_sources/magnetometer/mag_control.cpp +++ b/src/modules/ekf2/EKF/aid_sources/magnetometer/mag_control.cpp @@ -245,6 +245,7 @@ void Ekf::controlMagFusion() if (reset_heading) { _control_status.flags.yaw_align = true; + resetAidSourceStatusZeroInnovation(aid_src); } _control_status.flags.mag = true;