Browse Source

Plane: initialise target height correctly on quadplane transition

this fixes a bug where a plane in QSTABILIZE would drop suddenly if
switched to FBWA when the target altitude had not been initialised
mission-4.1.18
Andrew Tridgell 8 years ago
parent
commit
af97a3974b
  1. 6
      ArduPlane/quadplane.cpp

6
ArduPlane/quadplane.cpp

@ -1112,6 +1112,12 @@ void QuadPlane::update_transition(void) @@ -1112,6 +1112,12 @@ void QuadPlane::update_transition(void)
}
transition_state = TRANSITION_AIRSPEED_WAIT;
transition_start_ms = millis();
if (!assisted_flight) {
// set alt target to current height on transition. This
// starts the Z controller off with the right values
pos_control->set_alt_target(inertial_nav.get_altitude());
pos_control->set_desired_velocity_z(inertial_nav.get_velocity_z());
}
assisted_flight = true;
} else {
assisted_flight = false;

Loading…
Cancel
Save