dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

mc_rate_control: publish torque&thrust sp for VTOLs during hover and transition

This commit is contained in:
Julien Lecoeur 2019-11-18 17:02:46 +01:00
parent 2b98add9ec
commit 0fede1ff50
1 changed files with 8 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/modules/mc_rate_control/MulticopterRateControl.cpp
View File

@ -309,10 +309,14 @@ MulticopterRateControl::Run()
_controller_status_pub.publish(rate_ctrl_status);
// publish controller output
publish_actuator_controls();
publish_angular_acceleration_setpoint();
publish_torque_setpoint();
publish_thrust_setpoint();
if (!_vehicle_status.is_vtol
|| (_vehicle_status.is_vtol && (_vehicle_status.vehicle_type == vehicle_status_s::VEHICLE_TYPE_ROTARY_WING))
|| (_vehicle_status.is_vtol && _vehicle_status.in_transition_mode)) {
publish_actuator_controls();
publish_angular_acceleration_setpoint();
publish_torque_setpoint();
publish_thrust_setpoint();
}
} else if (_v_control_mode.flag_control_termination_enabled) {
if (!_vehicle_status.is_vtol) {