AHRS_HIL: call update_trig

11 years ago · 98d667c916
1 changed files with 3 additions and 0 deletions
--- a/libraries/AP_AHRS/AP_AHRS_HIL.cpp
+++ b/libraries/AP_AHRS/AP_AHRS_HIL.cpp
@ -35,6 +35,9 @@ AP_AHRS_HIL::setHil(float _roll, float _pitch, float _yaw,
				@@ -35,6 +35,9 @@ AP_AHRS_HIL::setHil(float _roll, float _pitch, float _yaw,
    yaw_sensor   = ToDeg(yaw)*100;

    _dcm_matrix.from_euler(roll, pitch, yaw);
+
+    // update trig values including _cos_roll, cos_pitch
+    update_trig();
 }

 // reset the current attitude, used by HIL