Tailsitter add yaw controls

This commit is contained in:
Jaeyoung Lim
2023-01-11 13:38:59 +01:00
parent af336719e6
commit 18e79c9649
@@ -364,8 +364,11 @@ void Tailsitter::fill_actuator_outputs()
} else {
fw_out[actuator_controls_s::INDEX_ROLL] = fw_in[actuator_controls_s::INDEX_ROLL];
fw_out[actuator_controls_s::INDEX_PITCH] = fw_in[actuator_controls_s::INDEX_PITCH];
_torque_setpoint_1->xyz[0] = fw_in[actuator_controls_s::INDEX_YAW];
_torque_setpoint_1->xyz[1] = fw_in[actuator_controls_s::INDEX_PITCH];
_torque_setpoint_1->xyz[2] = -fw_in[actuator_controls_s::INDEX_ROLL];
// PX4_INFO("fw_in: (%f, %f, %f)", double(fw_in[actuator_controls_s::INDEX_ROLL]),
// double(fw_in[actuator_controls_s::INDEX_PITCH]), double(fw_in[actuator_controls_s::INDEX_YAW]));
}
_actuators_out_0->timestamp_sample = _actuators_mc_in->timestamp_sample;