mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 02:33:33 +08:00
set vel_pos_test_ratio to zero if no fusion happens
This commit is contained in:
committed by
Paul Riseborough
parent
4b30de587f
commit
bd8f05567a
@@ -168,6 +168,8 @@ void Ekf::fuseVelPosHeight()
|
||||
// Compute the ratio of innovation to gate size
|
||||
_vel_pos_test_ratio[obs_index] = sq(innovation[obs_index]) / (sq(gate_size[obs_index]) *
|
||||
_vel_pos_innov_var[obs_index]);
|
||||
}else{
|
||||
_vel_pos_test_ratio[obs_index] = 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user