From 082c5021eea778c249bf05ce63c4f3df10432dcb Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Mon, 3 Feb 2014 20:49:16 +0900 Subject: [PATCH] AC_AttControlHeli: add comments --- libraries/AC_AttitudeControl/AC_AttitudeControl_Heli.cpp | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/libraries/AC_AttitudeControl/AC_AttitudeControl_Heli.cpp b/libraries/AC_AttitudeControl/AC_AttitudeControl_Heli.cpp index b268cd1c5e..2e9d145659 100644 --- a/libraries/AC_AttitudeControl/AC_AttitudeControl_Heli.cpp +++ b/libraries/AC_AttitudeControl/AC_AttitudeControl_Heli.cpp @@ -159,6 +159,14 @@ void AC_AttitudeControl_Heli::rate_bf_to_motor_roll_pitch(float rate_roll_target motor_pitch = pitch_out; /* +#if HELI_CC_COMP == ENABLED +static LowPassFilterFloat rate_dynamics_filter; // Rate Dynamics filter +#endif + +#if HELI_CC_COMP == ENABLED + rate_dynamics_filter.set_cutoff_frequency(0.01f, 4.0f); +#endif + #if AC_ATTITUDE_HELI_CC_COMP == ENABLED // Do cross-coupling compensation for low rpm helis // Credit: Jolyon Saunders