AHRS_HIL: call update_trig

2014-02-08 15:52:27 +09:00 · 2014-02-08 15:52:27 +09:00 · 98d667c916
parent 6946d68318
commit 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,
    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