Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-21 23:33:57 -04:00
Code Issues Packages Projects Releases Wiki Activity

Plane: fix acro stabilization check

Browse Source
This commit is contained in:
Mark Whitehorn 2019-05-04 08:52:53 -06:00 committed by Andrew Tridgell
parent 4a7ce1b384
commit aeaff72e14
1 changed files with 7 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
ArduPlane/quadplane.cpp
View File

@ -1869,11 +1869,6 @@ void QuadPlane::control_run(void)
switch (plane.control_mode->mode_number()) {
case Mode::Number::QACRO:
control_qacro();
if (!is_tailsitter()) {
// also stabilize using fixed wing surfaces
plane.stabilize_acro(plane.get_speed_scaler());
}
return;
break;
case Mode::Number::QSTABILIZE:
control_stabilize();
@ -1896,10 +1891,15 @@ void QuadPlane::control_run(void)
default:
break;
}
// we also stabilize using fixed wing surfaces
float speed_scaler = plane.get_speed_scaler();
plane.stabilize_roll(speed_scaler);
plane.stabilize_pitch(speed_scaler);
if (plane.control_mode->mode_number() == Mode::Number::QACRO) {
plane.stabilize_acro(speed_scaler);
} else {
plane.stabilize_roll(speed_scaler);
plane.stabilize_pitch(speed_scaler);
}
}
/*