mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-20 19:36:19 +08:00
[rotorcraft] fix hidden bug in ref_quat_float
thanks Antoine
This commit is contained in:
+1
-1
@@ -120,7 +120,7 @@ void stabilization_attitude_ref_update(void) {
|
||||
FLOAT_QUAT_DIFFERENTIAL(delta_q, stab_att_ref_rate, DT_UPDATE);
|
||||
/* compose new ref_quat by quaternion multiplication of delta rotation and current ref_quat */
|
||||
struct FloatQuat new_ref_quat;
|
||||
FLOAT_QUAT_COMP(new_ref_quat, delta_q, stab_att_ref_quat);
|
||||
FLOAT_QUAT_COMP(new_ref_quat, stab_att_ref_quat, delta_q);
|
||||
QUAT_COPY(stab_att_ref_quat, new_ref_quat);
|
||||
#endif
|
||||
FLOAT_QUAT_NORMALIZE(stab_att_ref_quat);
|
||||
|
||||
Reference in New Issue
Block a user