Browse Source

ekf rng kin: reduce minimum rng variance

v1.13.0-BW
bresch 3 years ago committed by Mathieu Bresciani
parent
commit
37cafe7dcd
  1. 2
      src/modules/ekf2/EKF/ekf_helper.cpp

2
src/modules/ekf2/EKF/ekf_helper.cpp

@ -1365,7 +1365,7 @@ float Ekf::getRngHeightVariance() const
{ {
const float dist_dependant_var = sq(_params.range_noise_scaler * _range_sensor.getDistBottom()); const float dist_dependant_var = sq(_params.range_noise_scaler * _range_sensor.getDistBottom());
const float var = sq(_params.range_noise) + dist_dependant_var; const float var = sq(_params.range_noise) + dist_dependant_var;
const float var_sat = fmaxf(var, 0.01f); const float var_sat = fmaxf(var, 0.001f);
return var_sat; return var_sat;
} }

Loading…
Cancel
Save