aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

APM: ensure DO_SET_SERVO channels are enabled

Browse Source
This commit is contained in:
Andrew Tridgell 2012-09-09 09:27:29 +10:00
parent 1e51988ecc
commit cf9dd9281c
2 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
ArduPlane/GCS_Mavlink.pde
View File

@ -1106,6 +1106,7 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
break; break;
case MAV_CMD_DO_SET_SERVO: case MAV_CMD_DO_SET_SERVO:
APM_RC.enable_out(packet.param1 - 1);
APM_RC.OutputCh(packet.param1 - 1, packet.param2); APM_RC.OutputCh(packet.param1 - 1, packet.param2);
result = MAV_RESULT_ACCEPTED; result = MAV_RESULT_ACCEPTED;
break; break;

1
ArduPlane/commands_logic.pde
View File

@ -576,6 +576,7 @@ static void do_set_home()
static void do_set_servo() static void do_set_servo()
{ {
APM_RC.enable_out(next_nonnav_command.p1 - 1);
APM_RC.OutputCh(next_nonnav_command.p1 - 1, next_nonnav_command.alt); APM_RC.OutputCh(next_nonnav_command.p1 - 1, next_nonnav_command.alt);
} }