mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-17 10:43:35 +08:00
Update time of last fusion event really only if fused
Except for the velpos fusion
This commit is contained in:
committed by
Mathieu Bresciani
parent
efd96db49d
commit
05855b7fc1
@@ -159,9 +159,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
|
||||
@@ -211,6 +208,7 @@ void Ekf::fuseAirspeed()
|
||||
// apply the state corrections
|
||||
fuse(Kfusion, _airspeed_innov);
|
||||
|
||||
_time_last_arsp_fuse = _time_last_imu;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user