From b9b3a39a8307c7c08f81d7ceb1f1ad7554942737 Mon Sep 17 00:00:00 2001 From: Randy Mackay Date: Sun, 27 Apr 2014 16:17:05 +0900 Subject: [PATCH] Copter: fence enable/disable via MAVLink --- ArduCopter/GCS_Mavlink.pde | 20 ++++++++++++++++++++ 1 file changed, 20 insertions(+) diff --git a/ArduCopter/GCS_Mavlink.pde b/ArduCopter/GCS_Mavlink.pde index 80f5050f4a..522dd9e305 100644 --- a/ArduCopter/GCS_Mavlink.pde +++ b/ArduCopter/GCS_Mavlink.pde @@ -1316,6 +1316,26 @@ void GCS_MAVLINK::handleMessage(mavlink_message_t* msg) } break; + case MAV_CMD_DO_FENCE_ENABLE: +#if AC_FENCE == ENABLED + result = MAV_RESULT_ACCEPTED; + switch ((uint16_t)packet.param1) { + case 0: + fence.enable(false); + break; + case 1: + fence.enable(true); + break; + default: + result = MAV_RESULT_FAILED; + break; + } +#else + // if fence code is not included return failure + result = MAV_RESULT_FAILED; +#endif + break; + default: result = MAV_RESULT_UNSUPPORTED; break;