ekf: make range finder kin consistency gate tunable by parameter

This commit is contained in:
bresch
2022-04-13 11:41:48 +02:00
committed by Mathieu Bresciani
parent 079a5e92ba
commit 4c03f0bc50
6 changed files with 24 additions and 2 deletions
+15
View File
@@ -1114,6 +1114,21 @@ PARAM_DEFINE_FLOAT(EKF2_RNG_A_IGATE, 1.0f);
*/
PARAM_DEFINE_FLOAT(EKF2_RNG_QLTY_T, 1.0f);
/**
* Gate size used for range finder kinematic consistency check
*
* To be used, the time derivative of the distance sensor measurements projected on the vertical axis
* needs to be statistically consistent with the estimated vertical velocity of the drone.
*
* Decrease this value to make the filter more robust against range finder faulty data (stuck, reflections, ...).
*
* @group EKF2
* @unit SD
* @min 0.01
* @max 5.0
*/
PARAM_DEFINE_FLOAT(EKF2_RNG_K_GATE, 0.2f);
/**
* Gate size for vision velocity estimate fusion
*