mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-23 06:03:35 +08:00
ekf2: use more efficient covariance update computation
KSK' is faster to compute than KHP and is mathematically equivalent
This commit is contained in:
@@ -331,7 +331,7 @@ void Ekf::fuseDrag(const dragSample &drag_sample)
|
||||
|
||||
// if the innovation consistency check fails then don't fuse the sample
|
||||
if (_drag_test_ratio(axis_index) <= 1.0f) {
|
||||
measurementUpdate(Kfusion, Hfusion, _drag_innov(axis_index));
|
||||
measurementUpdate(Kfusion, _drag_innov_var(axis_index), _drag_innov(axis_index));
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user