sensors: rc added low pass filter parameters

This commit is contained in:
Matthias Grob
2017-01-30 10:34:44 +01:00
committed by Lorenz Meier
parent c2be4b2b29
commit 81dcba3a2a
4 changed files with 42 additions and 0 deletions
+9
View File
@@ -125,6 +125,10 @@ int initialize_parameter_handles(ParameterHandles &parameter_handles)
parameter_handles.rc_trans_th = param_find("RC_TRANS_TH");
parameter_handles.rc_gear_th = param_find("RC_GEAR_TH");
/* RC low pass filter configuration */
parameter_handles.rc_flt_smp_rate = param_find("RC_FLT_SMP_RATE");
parameter_handles.rc_flt_cutoff = param_find("RC_FLT_CUTOFF");
/* Differential pressure offset */
parameter_handles.diff_pres_offset_pa = param_find("SENS_DPRES_OFF");
parameter_handles.diff_pres_analog_scale = param_find("SENS_DPRES_ANSC");
@@ -381,6 +385,11 @@ int update_parameters(const ParameterHandles &parameter_handles, Parameters &par
parameters.rc_gear_inv = (parameters.rc_gear_th < 0);
parameters.rc_gear_th = fabs(parameters.rc_gear_th);
param_get(parameter_handles.rc_flt_smp_rate, &(parameters.rc_flt_smp_rate));
parameters.rc_flt_smp_rate = math::max(1.0f, parameters.rc_flt_smp_rate);
param_get(parameter_handles.rc_flt_cutoff, &(parameters.rc_flt_cutoff));
parameters.rc_flt_cutoff = math::max(1.0f, parameters.rc_flt_cutoff);
/* Airspeed offset */
param_get(parameter_handles.diff_pres_offset_pa, &(parameters.diff_pres_offset_pa));
param_get(parameter_handles.diff_pres_analog_scale, &(parameters.diff_pres_analog_scale));