FW mode manager: during takeoff only set height rate, not altitude setpoint

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer
2025-06-18 13:53:13 +02:00
committed by Silvan
parent 76b3257276
commit 5b68537baf
@@ -1219,14 +1219,13 @@ FixedWingModeManager::control_auto_takeoff(const hrt_abstime &now, const float c
_param_fw_thr_idle.get() : NAN;
const fixed_wing_longitudinal_setpoint_s fw_longitudinal_control_sp = {
.timestamp = now,
.altitude = altitude_setpoint_amsl,
.height_rate = NAN,
.altitude = NAN,
.height_rate = _param_fw_t_clmb_max.get(),
.equivalent_airspeed = takeoff_airspeed,
.pitch_direct = NAN,
.throttle_direct = NAN
};
_longitudinal_ctrl_sp_pub.publish(fw_longitudinal_control_sp);
_ctrl_configuration_handler.setPitchMin(radians(_takeoff_pitch_min.get()));