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

EKF: fix bug causing height offset when GPS use stops

Browse Source 
This bug causes the last vertical velocity observation to be continuously fused.
This commit is contained in:
Paul Riseborough
2018-05-10 13:14:09 +10:00
committed by Lorenz Meier
parent b227aca4a8
commit 75e65901ae
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/vel_pos_fusion.cpp
+2 -2
View File
@@ -183,7 +183,7 @@ void Ekf::fuseVelPosHeight()
innov_check_pass_map[5] = (_vel_pos_test_ratio[5] <= 1.0f) || !_control_status.flags.tilt_align;
// record the successful velocity fusion event
if ((_fuse_hor_vel || _fuse_hor_vel_aux) && vel_check_pass) {
if ((_fuse_hor_vel || _fuse_hor_vel_aux || _fuse_vert_vel) && vel_check_pass) {
_time_last_vel_fuse = _time_last_imu;
_innov_check_fail_status.flags.reject_vel_NED = false;
@@ -191,7 +191,7 @@ void Ekf::fuseVelPosHeight()
_innov_check_fail_status.flags.reject_vel_NED = true;
}
_fuse_hor_vel = _fuse_hor_vel_aux = false;
_fuse_hor_vel = _fuse_hor_vel_aux = _fuse_vert_vel = false;
// record the successful position fusion event
if (pos_check_pass && _fuse_pos) {