fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-13 20:03:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

fw att fix pitch feedforward constrained roll

Browse Source
This commit is contained in:
Daniel Agar
2016-11-27 12:34:12 +01:00
committed by Lorenz Meier
parent a776b2c549
commit 983c44088f
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
attitude_fw/ecl_pitch_controller.cpp
+1 -1
View File
@@ -127,7 +127,7 @@ float ECL_PitchController::control_bodyrate(const struct ECL_ControlData &ctl_da
/* roll is used as feedforward term and inverted flight needs to be considered */
if (fabsf(ctl_data.roll) < math::radians(90.0f)) {
/* not inverted, but numerically still potentially close to infinity */
constrained_roll = math::constrain(ctl_data.roll, -ctl_data.roll_setpoint, ctl_data.roll_setpoint);
constrained_roll = math::constrain(ctl_data.roll, -fabsf(ctl_data.roll_setpoint), fabsf(ctl_data.roll_setpoint));
} else {
/* inverted flight, constrain on the two extremes of -pi..+pi to avoid infinity */