From 9b2a2b2c2e6f822ec7341592a8e8c6084abfaac4 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <tridge@samba.org>
Date: Mon, 3 Sep 2012 20:56:36 +1000
Subject: [PATCH] APM: support DO_SET_SERVO command

---
 ArduPlane/GCS_Mavlink.pde | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/ArduPlane/GCS_Mavlink.pde b/ArduPlane/GCS_Mavlink.pde
index a21687bca7..78dcee6b63 100644
--- a/ArduPlane/GCS_Mavlink.pde
+++ b/ArduPlane/GCS_Mavlink.pde
@@ -1105,6 +1105,10 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg)
             }
             break;
 
+        case MAV_CMD_DO_SET_SERVO:
+            APM_RC.OutputCh(packet.param1 - 1, packet.param2);
+            result = MAV_RESULT_ACCEPTED;
+            break;
 
         default:
             result = MAV_RESULT_UNSUPPORTED;