Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: Tailsitter: use motor I term for pitch in assist if not surfaces are setup

Browse Source
This commit is contained in:
Iampete1 2023-09-07 14:52:05 +01:00 committed by Andrew Tridgell
parent ea207c4b4a
commit fa1c5f62aa
1 changed files with 16 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
ArduPlane/tailsitter.cpp
View File

@ -366,20 +366,32 @@ void Tailsitter::output(void)
if (quadplane.option_is_set(QuadPlane::OPTION::TAILSIT_Q_ASSIST_MOTORS_ONLY)) { if (quadplane.option_is_set(QuadPlane::OPTION::TAILSIT_Q_ASSIST_MOTORS_ONLY)) {
// only use motors for Q assist, control surfaces remain under plane control. Zero copter I terms and use plane. // only use motors for Q assist, control surfaces remain under plane control. Zero copter I terms and use plane.
// Smoothly relax to zero so there is no step change in output, must also set limit flags so integrator cannot build faster than the relax. // Smoothly relax to zero so there is no step change in output, must also set limit flags so integrator cannot build faster than the relax.
// Assume there is always roll and pitch control surfaces, otherwise motors only assist should not be set. // Assume there is always roll control surfaces, otherwise motors only assist should not be set.
const float dt = quadplane.attitude_control->get_dt(); const float dt = quadplane.attitude_control->get_dt();
quadplane.attitude_control->get_rate_pitch_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC);
motors->limit.pitch = true; // VTOL yaw / FW roll
quadplane.attitude_control->get_rate_yaw_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC); quadplane.attitude_control->get_rate_yaw_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC);
motors->limit.yaw = true; motors->limit.yaw = true;
// VTOL and FW pitch
if (_have_elevator || _have_elevon || _have_v_tail) {
// have pitch control surfaces, use them
quadplane.attitude_control->get_rate_pitch_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC);
motors->limit.pitch = true;
} else {
// no pitch control surfaces, zero plane I terms and use motors
// We skip the outputting to surfaces for this axis from the copter controller but there are none setup
plane.pitchController.reset_I();
}
// VTOL roll / FW yaw
if (_have_rudder || _have_v_tail) { if (_have_rudder || _have_v_tail) {
// there are yaw control surfaces, zero motor I term // there are yaw control surfaces, zero motor I term
quadplane.attitude_control->get_rate_roll_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC); quadplane.attitude_control->get_rate_roll_pid().relax_integrator(0.0, dt, AC_ATTITUDE_RATE_RELAX_TC);
motors->limit.roll = true; motors->limit.roll = true;
} else { } else {
// no yaw control surfaces, zero plane I terms and use motors // no yaw control surfaces, zero plane I terms and use motors
// We skip the outputing to surfaces for this axis from the copter controller but there are none setup // We skip the outputting to surfaces for this axis from the copter controller but there are none setup
plane.yawController.reset_I(); plane.yawController.reset_I();
} }