From cecfad7219e125a2afc86b6c97000de3cd7b38c0 Mon Sep 17 00:00:00 2001
From: dheideman <dheideman@socal.rr.com>
Date: Fri, 28 Jul 2017 14:05:47 -0700
Subject: [PATCH] Add missing sub modes

---
 src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc | 12 ++++++++++++
 src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.h  | 12 ++++++------
 2 files changed, 18 insertions(+), 6 deletions(-)

diff --git a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc
index a3a76850d..c08a0fa96 100644
--- a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc
+++ b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc
@@ -35,7 +35,13 @@ APMSubMode::APMSubMode(uint32_t mode, bool settable) :
     QMap<uint32_t,QString> enumToString;
     enumToString.insert(MANUAL, "Manual");
     enumToString.insert(STABILIZE, "Stabilize");
+    enumToString.insert(ACRO, "Acro");
     enumToString.insert(ALT_HOLD,  "Depth Hold");
+    enumToString.insert(AUTO, "Auto");
+    enumToString.insert(GUIDED, "Guided");
+    enumToString.insert(CIRCLE, "Circle");
+    enumToString.insert(SURFACE, "Surface");
+    enumToString.insert(POSHOLD, "Position Hold");
 
     setEnumToStringMapping(enumToString);
 }
@@ -46,7 +52,13 @@ ArduSubFirmwarePlugin::ArduSubFirmwarePlugin(void):
     QList<APMCustomMode> supportedFlightModes;
     supportedFlightModes << APMSubMode(APMSubMode::MANUAL ,true);
     supportedFlightModes << APMSubMode(APMSubMode::STABILIZE ,true);
+    supportedFlightModes << APMSubMode(APMSubMode::ACRO ,true);
     supportedFlightModes << APMSubMode(APMSubMode::ALT_HOLD  ,true);
+    supportedFlightModes << APMSubMode(APMSubMode::AUTO ,true);
+    supportedFlightModes << APMSubMode(APMSubMode::GUIDED ,true);
+    supportedFlightModes << APMSubMode(APMSubMode::CIRCLE ,true);
+    supportedFlightModes << APMSubMode(APMSubMode::SURFACE ,false);
+    supportedFlightModes << APMSubMode(APMSubMode::POSHOLD ,true);
     setSupportedModes(supportedFlightModes);
 
     if (!_remapParamNameIntialized) {
diff --git a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.h b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.h
index 2b0c7aa04..8c050028e 100644
--- a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.h
+++ b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.h
@@ -68,22 +68,22 @@ class APMSubMode : public APMCustomMode
 public:
     enum Mode {
         STABILIZE         = 0,   // Hold level position
-        RESERVED_1        = 1,
+        ACRO              = 1,   // Manual angular rate, throttle
         ALT_HOLD          = 2,   // Depth hold
-        RESERVED_3        = 3,
-        RESERVED_4        = 4,
+        AUTO              = 3,   // Full auto to waypoint
+        GUIDED            = 4,   // Full auto to coordinate/direction
         RESERVED_5        = 5,
         RESERVED_6        = 6,
-        RESERVED_7        = 7,
+        CIRCLE            = 7,   // Auto circling
         RESERVED_8        = 8,
-        RESERVED_9        = 9,
+        SURFACE           = 9,   // Auto return to surface
         RESERVED_10       = 10,
         RESERVED_11       = 11,
         RESERVED_12       = 12,
         RESERVED_13       = 13,
         RESERVED_14       = 14,
         RESERVED_15       = 15,
-        RESERVED_16       = 16,
+        POSHOLD           = 16,  // Hold position
         RESERVED_17       = 17,
         RESERVED_18       = 18,
         MANUAL            = 19
-- 
2.22.0