forked from Archive/PX4-Autopilot
FW Attitude Controller: fix manual yaw rate setpoint limit (#22812)
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
parent
051baec9c4
commit
086656dc7f
|
@ -361,7 +361,7 @@ void FixedwingAttitudeControl::Run()
|
|||
|
||||
/* add yaw rate setpoint from sticks in all attitude-controlled modes */
|
||||
if (_vcontrol_mode.flag_control_manual_enabled) {
|
||||
body_rates_setpoint(2) += math::constrain(_manual_control_setpoint.yaw * radians(_param_fw_y_rmax.get()),
|
||||
body_rates_setpoint(2) += math::constrain(_manual_control_setpoint.yaw * radians(_param_man_yr_max.get()),
|
||||
-radians(_param_fw_y_rmax.get()), radians(_param_fw_y_rmax.get()));
|
||||
}
|
||||
|
||||
|
|
|
@ -155,7 +155,8 @@ private:
|
|||
(ParamFloat<px4::params::FW_WR_IMAX>) _param_fw_wr_imax,
|
||||
(ParamFloat<px4::params::FW_WR_P>) _param_fw_wr_p,
|
||||
|
||||
(ParamFloat<px4::params::FW_Y_RMAX>) _param_fw_y_rmax
|
||||
(ParamFloat<px4::params::FW_Y_RMAX>) _param_fw_y_rmax,
|
||||
(ParamFloat<px4::params::FW_MAN_YR_MAX>) _param_man_yr_max
|
||||
|
||||
)
|
||||
|
||||
|
|
Loading…
Reference in New Issue