mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 05:03:33 +08:00
ekf rng kin: reduce minimum rng variance
This commit is contained in:
committed by
Mathieu Bresciani
parent
4994649500
commit
37cafe7dcd
@@ -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;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user