fw offboard control mode: altitude control enabled (#23041)

PX4 · Apr 22, 2024 · c7725d7 · c7725d7
1 parent 0a7689f
commit c7725d7
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/src/modules/fw_pos_control/FixedwingPositionControl.cpp b/src/modules/fw_pos_control/FixedwingPositionControl.cpp
@@ -1404,6 +1404,9 @@ FixedwingPositionControl::control_auto_path(const float control_interval, const
 				   tecs_fw_thr_max,
 				   _param_sinkrate_target.get(),
 				   _param_climbrate_target.get());
+
+	_att_sp.thrust_body[0] = min(get_tecs_thrust(), tecs_fw_thr_max);
+	_att_sp.pitch_body = get_tecs_pitch();
 }
 
 void