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

ekf2: delete obsolete _bad_vert_accel_detected

Browse Source
This commit is contained in:
Daniel Agar
2021-12-13 09:13:39 -05:00
parent 986cf288da
commit fc17797548
2 changed files with 2 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/EKF/vel_pos_fusion.cpp
+2 -2
View File
@@ -86,7 +86,7 @@ bool Ekf::fuseVerticalVelocity(const Vector3f &innov, const Vector2f &innov_gate
// but limit innovation to prevent spikes that could destabilise the filter
float innovation;
if (_bad_vert_accel_detected && !innov_check_pass) {
if (_fault_status.flags.bad_acc_vertical && !innov_check_pass) {
const float innov_limit = innov_gate(1) * sqrtf(innov_var(2));
innovation = math::constrain(innov(2), -innov_limit, innov_limit);
innov_check_pass = true;
@@ -160,7 +160,7 @@ bool Ekf::fuseVerticalPosition(const Vector3f &innov, const Vector2f &innov_gate
// but limit innovation to prevent spikes that could destabilise the filter
float innovation;
if (_bad_vert_accel_detected && !innov_check_pass) {
if (_fault_status.flags.bad_acc_vertical && !innov_check_pass) {
const float innov_limit = innov_gate(1) * sqrtf(innov_var(2));
innovation = math::constrain(innov(2), -innov_limit, innov_limit);
innov_check_pass = true;