aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AC_AttitudeControl: added get_rpy_srate()

Browse Source 
and remove dmod binding, as slew rate turned out to be more useful
This commit is contained in:
Andrew Tridgell 2022-04-30 19:25:33 +10:00
parent b56bd41034
commit 99a6cb69f8
2 changed files with 9 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
libraries/AC_AttitudeControl/AC_AttitudeControl.cpp
View File

@ -1133,12 +1133,12 @@ bool AC_AttitudeControl::pre_arm_checks(const char *param_prefix,
}
/*
get the PDmod value for roll, pitch and yaw, for oscillation
get the slew rate for roll, pitch and yaw, for oscillation
detection in lua scripts
*/
void AC_AttitudeControl::get_rpy_PDmod(float &roll_dmod, float &pitch_dmod, float &yaw_dmod)
void AC_AttitudeControl::get_rpy_srate(float &roll_srate, float &pitch_srate, float &yaw_srate)
{
roll_dmod = get_rate_roll_pid().get_pid_info().Dmod;
pitch_dmod = get_rate_pitch_pid().get_pid_info().Dmod;
yaw_dmod = get_rate_yaw_pid().get_pid_info().Dmod;
roll_srate = get_rate_roll_pid().get_pid_info().slew_rate;
pitch_srate = get_rate_pitch_pid().get_pid_info().slew_rate;
yaw_srate = get_rate_yaw_pid().get_pid_info().slew_rate;
}

4
libraries/AC_AttitudeControl/AC_AttitudeControl.h
View File

@ -368,8 +368,8 @@ public:
// enable inverted flight on backends that support it
virtual void set_inverted_flight(bool inverted) {}
// get the PDmod value for roll, pitch and yaw, for oscillation detection in lua scripts
void get_rpy_PDmod(float &roll_dmod, float &pitch_dmod, float &yaw_dmod);
// get the slew rate value for roll, pitch and yaw, for oscillation detection in lua scripts
void get_rpy_srate(float &roll_srate, float &pitch_srate, float &yaw_srate);
// User settable parameters
static const struct AP_Param::GroupInfo var_info[];