fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 01:21:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2: Add parameters to control output filter

Browse Source
This commit is contained in:
Paul Riseborough
2016-05-14 11:24:41 +02:00
committed by Lorenz Meier
parent 5f2c2f8392
commit 3aa2297497
2 changed files with 29 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/ekf2_main.cpp
+7 -1
View File
@@ -244,6 +244,10 @@ private:
control::BlockParamFloat _flow_pos_y; // Y position of optical flow sensor focal point in body frame (m) control::BlockParamFloat _flow_pos_y; // Y position of optical flow sensor focal point in body frame (m)
control::BlockParamFloat _flow_pos_z; // Z position of optical flow sensor focal point in body frame (m) control::BlockParamFloat _flow_pos_z; // Z position of optical flow sensor focal point in body frame (m)
// output predictor filter time constants
control::BlockParamFloat _tau_vel; // time constant used by the output velocity complementary filter (s)
control::BlockParamFloat _tau_pos; // time constant used by the output position complementary filter (s)
int update_subscriptions(); int update_subscriptions();
}; };
@@ -326,7 +330,9 @@ Ekf2::Ekf2():
_rng_pos_z(this, "EKF2_RNG_POS_Z", false, &_params->rng_pos_body(2)), _rng_pos_z(this, "EKF2_RNG_POS_Z", false, &_params->rng_pos_body(2)),
_flow_pos_x(this, "EKF2_OF_POS_X", false, &_params->flow_pos_body(0)), _flow_pos_x(this, "EKF2_OF_POS_X", false, &_params->flow_pos_body(0)),
_flow_pos_y(this, "EKF2_OF_POS_Y", false, &_params->flow_pos_body(1)), _flow_pos_y(this, "EKF2_OF_POS_Y", false, &_params->flow_pos_body(1)),
_flow_pos_z(this, "EKF2_OF_POS_Z", false, &_params->flow_pos_body(2)) _flow_pos_z(this, "EKF2_OF_POS_Z", false, &_params->flow_pos_body(2)),
_tau_vel(this, "EKF2_TAU_VEL", false, &_params->vel_Tau),
_tau_pos(this, "EKF2_TAU_POS", false, &_params->pos_Tau)
{ {
} }
src/modules/ekf2/ekf2_params.c
+22
View File
@@ -699,3 +699,25 @@ PARAM_DEFINE_FLOAT(EKF2_OF_POS_Y, 0.0f);
* @decimal 3 * @decimal 3
*/ */
PARAM_DEFINE_FLOAT(EKF2_OF_POS_Z, 0.0f); PARAM_DEFINE_FLOAT(EKF2_OF_POS_Z, 0.0f);
/**
* Time constant of the velocity output prediction and smoothing filter
*
* @group EKF2
* @min 0.1
* @max 1.0
* @unit s
* @decimal 2
*/
PARAM_DEFINE_FLOAT(EKF2_TAU_VEL, 0.5f);
/**
* Time constant of the position output prediction and smoothing filter
*
* @group EKF2
* @min 0.1
* @max 1.0
* @unit s
* @decimal 2
*/
PARAM_DEFINE_FLOAT(EKF2_TAU_POS, 0.25f);