diff --git a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
index 970a8a8398..6d0ae49aa9 100644
--- a/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
+++ b/libraries/AP_AHRS/AP_AHRS_NavEKF.cpp
@@ -77,6 +77,7 @@ void AP_AHRS_NavEKF::update(void)
             yaw_sensor   = degrees(yaw) * 100;
             if (yaw_sensor < 0)
                 yaw_sensor += 36000;
+            update_trig();
         }
     }
 }