fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-29 07:23:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

EKF: protect covariance prediction from delta time errors

Browse Source 
Allow time step to vary by a factor of 2 to allow for jitter.
This commit is contained in:
Paul Riseborough
2017-04-06 13:34:37 +10:00
parent fa07536314
commit bef7325884
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
EKF/covariance.cpp
+1 -1
View File
@@ -143,7 +143,7 @@ void Ekf::predictCovariance()
float dvy_b = _state.accel_bias(1); float dvy_b = _state.accel_bias(1);
float dvz_b = _state.accel_bias(2); float dvz_b = _state.accel_bias(2);
float dt = _imu_sample_delayed.delta_ang_dt; float dt = math::constrain(_imu_sample_delayed.delta_ang_dt, 0.0005f * FILTER_UPDATE_PERIOD_MS, 0.002f * FILTER_UPDATE_PERIOD_MS);
// compute noise variance for stationary processes // compute noise variance for stationary processes
float process_noise[_k_num_states] = {}; float process_noise[_k_num_states] = {};