mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-17 16:17:36 +08:00
EKF: Only record airspeed fusion event when states are updated
This commit is contained in:
committed by
Paul Riseborough
parent
486a461a5e
commit
06aa78a291
@@ -152,9 +152,6 @@ void Ekf::fuseAirspeed()
|
|||||||
_innov_check_fail_status.flags.reject_airspeed = false;
|
_innov_check_fail_status.flags.reject_airspeed = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Airspeed measurement sample has passed check so record it
|
|
||||||
_time_last_arsp_fuse = _time_last_imu;
|
|
||||||
|
|
||||||
// apply covariance correction via P_new = (I -K*H)*P
|
// apply covariance correction via P_new = (I -K*H)*P
|
||||||
// first calculate expression for KHP
|
// first calculate expression for KHP
|
||||||
// then calculate P - KHP
|
// then calculate P - KHP
|
||||||
|
|||||||
Reference in New Issue
Block a user