ekf rng kin: reduce minimum rng variance

This commit is contained in:
bresch
2022-04-13 11:41:48 +02:00
committed by Mathieu Bresciani
parent 4994649500
commit 37cafe7dcd
+1 -1
View File
@@ -1365,7 +1365,7 @@ float Ekf::getRngHeightVariance() const
{
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_sat = fmaxf(var, 0.01f);
const float var_sat = fmaxf(var, 0.001f);
return var_sat;
}