fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-16 22:37:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf: correct quaternion multiplication order

Browse Source
This commit is contained in:
CarlOlsson
2019-05-21 11:31:36 +02:00
committed by Paul Riseborough
parent d6351bd7a5
commit ad7f7af03b
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/ekf_helper.cpp
+2 -2
View File
@@ -516,7 +516,7 @@ bool Ekf::realignYawGPS()
// apply the change in attitude quaternion to our newest quaternion estimate
// which was already taken out from the output buffer
_output_new.quat_nominal = _state_reset_status.quat_change * _output_new.quat_nominal;
_output_new.quat_nominal = _output_new.quat_nominal * _state_reset_status.quat_change;
// capture the reset event
_state_reset_status.quat_counter++;
@@ -756,7 +756,7 @@ bool Ekf::resetMagHeading(Vector3f &mag_init, bool increase_yaw_var, bool update
// apply the change in attitude quaternion to our newest quaternion estimate
// which was already taken out from the output buffer
_output_new.quat_nominal = _state_reset_status.quat_change * _output_new.quat_nominal;
_output_new.quat_nominal = _output_new.quat_nominal * _state_reset_status.quat_change;
}
// capture the reset event