From 127117b640c9d10d168eb20c61c008742fa28732 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <tridge@samba.org>
Date: Sun, 9 Sep 2012 09:27:29 +1000
Subject: [PATCH] APM: ensure DO_SET_SERVO channels are enabled

---
 ArduPlane/GCS_Mavlink.pde    | 1 +
 ArduPlane/commands_logic.pde | 1 +
 2 files changed, 2 insertions(+)

diff --git a/ArduPlane/GCS_Mavlink.pde b/ArduPlane/GCS_Mavlink.pde
index 62b9cef019..eb4514933c 100644
--- a/ArduPlane/GCS_Mavlink.pde
+++ b/ArduPlane/GCS_Mavlink.pde
@@ -1106,6 +1106,7 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
             break;
 
         case MAV_CMD_DO_SET_SERVO:
+            APM_RC.enable_out(packet.param1 - 1);
             APM_RC.OutputCh(packet.param1 - 1, packet.param2);
             result = MAV_RESULT_ACCEPTED;
             break;
diff --git a/ArduPlane/commands_logic.pde b/ArduPlane/commands_logic.pde
index 547f3e16d1..9786b0e3b1 100644
--- a/ArduPlane/commands_logic.pde
+++ b/ArduPlane/commands_logic.pde
@@ -576,6 +576,7 @@ static void do_set_home()
 
 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);
 }