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

EKF: update comment

Browse Source
This commit is contained in:
CarlOlsson
2019-05-21 11:30:40 +02:00
committed by Paul Riseborough
parent 7612fa40ed
commit d6351bd7a5
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
@@ -509,7 +509,7 @@ bool Ekf::realignYawGPS()
_state_reset_status.quat_change = quat_before_reset.inversed() * _state.quat_nominal; _state_reset_status.quat_change = quat_before_reset.inversed() * _state.quat_nominal;
// add the reset amount to the output observer buffered data // add the reset amount to the output observer buffered data
// Note q1 *= q2 is equivalent to q1 = q2 * q1 // Note q1 *= q2 is equivalent to q1 = q1 * q2
for (uint8_t i = 0; i < _output_buffer.get_length(); i++) { for (uint8_t i = 0; i < _output_buffer.get_length(); i++) {
_output_buffer[i].quat_nominal *= _state_reset_status.quat_change; _output_buffer[i].quat_nominal *= _state_reset_status.quat_change;
} }
@@ -750,7 +750,7 @@ bool Ekf::resetMagHeading(Vector3f &mag_init, bool increase_yaw_var, bool update
if (update_buffer) { if (update_buffer) {
// add the reset amount to the output observer buffered data // add the reset amount to the output observer buffered data
for (uint8_t i = 0; i < _output_buffer.get_length(); i++) { for (uint8_t i = 0; i < _output_buffer.get_length(); i++) {
// Note q1 *= q2 is equivalent to q1 = q2 * q1 // Note q1 *= q2 is equivalent to q1 = q1 * q2
_output_buffer[i].quat_nominal *= _state_reset_status.quat_change; _output_buffer[i].quat_nominal *= _state_reset_status.quat_change;
} }