dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

EKF: improve covariance stability when estimating wind

This commit is contained in:
Paul Riseborough 2017-04-10 15:55:47 +10:00 committed by Lorenz Meier
parent 5cf31e439d
commit 9f48c0505b
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
EKF/covariance.cpp
View File

@ -204,7 +204,7 @@ void Ekf::predictCovariance()
float wind_vel_sig;
// Don't continue to grow wind velocity state variances if they are becoming too large or we are not using wind velocity states as this can make the covariance matrix badly conditioned
if (_control_status.flags.wind && (P[22][22] + P[23][23]) < 1000.0f) {
if (_control_status.flags.wind && (P[22][22] + P[23][23]) < 2.0f) {
wind_vel_sig = dt * math::constrain(_params.wind_vel_p_noise, 0.0f, 1.0f);
} else {