diff --git a/EKF/covariance.cpp b/EKF/covariance.cpp index 0e2591ff54..461199c068 100644 --- a/EKF/covariance.cpp +++ b/EKF/covariance.cpp @@ -143,7 +143,7 @@ void Ekf::predictCovariance() float dvy_b = _state.accel_bias(1); 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 float process_noise[_k_num_states] = {};