tap_esc: fix output order for quadrotor

This commit is contained in:
Lucas De Marchi 2016-09-27 16:36:59 -03:00 committed by Lorenz Meier
parent 8b237d7cf3
commit c5100b6273

View File

@ -711,6 +711,13 @@ TAP_ESC::cycle()
motor_out[6] = RPMSTOPPED;
motor_out[7] = RPMSTOPPED;
} else if (num_outputs == 4) {
motor_out[0] = _outputs.output[2];
motor_out[2] = _outputs.output[0];
motor_out[1] = _outputs.output[1];
motor_out[3] = _outputs.output[3];
} else {
// Use the system defaults