diff --git a/libraries/AP_AHRS/AP_AHRS_DCM.cpp b/libraries/AP_AHRS/AP_AHRS_DCM.cpp index 529e1c2309..4990b91854 100644 --- a/libraries/AP_AHRS/AP_AHRS_DCM.cpp +++ b/libraries/AP_AHRS/AP_AHRS_DCM.cpp @@ -76,6 +76,9 @@ AP_AHRS_DCM::update(void) // Calculate pitch, roll, yaw for stabilization and navigation euler_angles(); + + // update trig values including _cos_roll, cos_pitch + update_trig(); } // update the DCM matrix using only the gyros