From 98d667c91652de7c6dde9d12b8cb815f6195e3d9 Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Sat, 8 Feb 2014 15:52:27 +0900 Subject: [PATCH] AHRS_HIL: call update_trig --- libraries/AP_AHRS/AP_AHRS_HIL.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/libraries/AP_AHRS/AP_AHRS_HIL.cpp b/libraries/AP_AHRS/AP_AHRS_HIL.cpp index b897d7325f..7c722cfe84 100644 --- 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