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

EKF: fix bug in IMU error application timing patch

Browse Source
This commit is contained in:
Paul Riseborough
2016-04-30 15:11:12 +10:00
parent 6ecbefd7e4
commit 6c57bea1c3
1 changed files with 1 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/ekf.cpp
+1 -2
View File
@@ -530,8 +530,7 @@ void Ekf::predictState()
corrected_delta_vel(2) -= _state.accel_z_bias;
// correct delta angles for earth rotation rate
corrected_delta_ang = _imu_sample_delayed.delta_ang - _R_to_earth.transpose() * _earth_rate_NED *
_imu_sample_delayed.delta_ang_dt;
corrected_delta_ang -= _R_to_earth.transpose() * _earth_rate_NED * _imu_sample_delayed.delta_ang_dt;
// convert the delta angle to a delta quaternion
Quaternion dq;