Skip to content

Commit

Permalink
ekf2: add parameter to change range finder quality hysteresis (#634)
Browse files Browse the repository at this point in the history
* ekf2: add parameter to change range finder quality hysteresis
* Update ecl
  • Loading branch information
cmic0 authored Sep 24, 2020
1 parent f83f3ac commit 3cfbf9a
Show file tree
Hide file tree
Showing 3 changed files with 15 additions and 1 deletion.
2 changes: 1 addition & 1 deletion src/lib/ecl
Submodule ecl updated from 56a121 to 59bcae
3 changes: 3 additions & 0 deletions src/modules/ekf2/ekf2_main.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -409,6 +409,8 @@ class Ekf2 final : public ModuleBase<Ekf2>, public ModuleParams, public px4::Sch
_param_ekf2_rng_a_hmax, ///< maximum allowed absolute altitude (AGL) for range aid (m)
(ParamExtFloat<px4::params::EKF2_RNG_A_IGATE>)
_param_ekf2_rng_a_igate, ///< gate size used for innovation consistency checks for range aid fusion (STD)
(ParamExtFloat<px4::params::EKF2_RNG_QLTY_T>)
_param_ekf2_rng_qlty_t, ///< Minimum duration during which the reported range finder signal quality needs to be non-zero in order to be declared valid (s)

// vision estimate fusion
(ParamInt<px4::params::EKF2_EV_NOISE_MD>)
Expand Down Expand Up @@ -611,6 +613,7 @@ Ekf2::Ekf2(bool replay_mode):
_param_ekf2_rng_a_vmax(_params->max_vel_for_range_aid),
_param_ekf2_rng_a_hmax(_params->max_hagl_for_range_aid),
_param_ekf2_rng_a_igate(_params->range_aid_innov_gate),
_param_ekf2_rng_qlty_t(_params->range_valid_quality_s),
_param_ekf2_evv_gate(_params->ev_vel_innov_gate),
_param_ekf2_evp_gate(_params->ev_pos_innov_gate),
_param_ekf2_of_n_min(_params->flow_noise),
Expand Down
11 changes: 11 additions & 0 deletions src/modules/ekf2/ekf2_params.c
Original file line number Diff line number Diff line change
Expand Up @@ -1197,6 +1197,17 @@ PARAM_DEFINE_FLOAT(EKF2_RNG_A_HMAX, 5.0f);
*/
PARAM_DEFINE_FLOAT(EKF2_RNG_A_IGATE, 1.0f);

/**
* Minimum duration during which the reported range finder signal quality needs to be non-zero in order to be declared valid (s)
*
*
* @group EKF2
* @unit s
* @min 0.1
* @max 5
*/
PARAM_DEFINE_FLOAT(EKF2_RNG_QLTY_T, 1.0f);

/**
* Gate size for vision velocity estimate fusion
*
Expand Down

0 comments on commit 3cfbf9a

Please sign in to comment.