Browse Source

fw pos ctrl: mark completed manual takeoff true if rotary wing and armed

main
Thomas Stastny 3 years ago committed by Daniel Agar
parent
commit
69bc5d37bc
  1. 5
      src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp

5
src/modules/fw_pos_control_l1/FixedwingPositionControl.cpp

@ -725,8 +725,9 @@ FixedwingPositionControl::updateManualTakeoffStatus() @@ -725,8 +725,9 @@ FixedwingPositionControl::updateManualTakeoffStatus()
if (!_completed_manual_takeoff) {
const bool at_controllable_airspeed = _airspeed > _param_fw_airspd_min.get()
|| !_airspeed_valid;
_completed_manual_takeoff = !_landed
&& at_controllable_airspeed;
const bool is_hovering = _vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING
&& _control_mode.flag_armed;
_completed_manual_takeoff = (!_landed && at_controllable_airspeed) || is_hovering;
}
}

Loading…
Cancel
Save