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

EKF: Only record airspeed fusion event when states are updated

Browse Source
This commit is contained in:
Paul Riseborough 2020-08-15 09:29:57 +10:00 committed by Paul Riseborough
parent 486a461a5e
commit 06aa78a291
1 changed files with 0 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
EKF/airspeed_fusion.cpp
View File

@ -152,9 +152,6 @@ void Ekf::fuseAirspeed()
_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
// first calculate expression for KHP
// then calculate P - KHP