diff --git a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc
index 60dfe3c1526f7d1cea4725a54e5b02a71d2cd855..6661b663b7c8d984dec6e60b5aa7222406c2ba35 100644
--- a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc
+++ b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc
@@ -39,6 +39,7 @@ APMPlaneMode::APMPlaneMode(uint32_t mode, bool settable)
         { QRTL,             "QuadPlane RTL" },
         { QAUTOTUNE,        "QuadPlane AutoTune" },
         { QACRO,            "QuadPlane Acro" },
+        { THERMAL,          "Thermal"},
     });
 }
 
@@ -68,6 +69,7 @@ ArduPlaneFirmwarePlugin::ArduPlaneFirmwarePlugin(void)
         APMPlaneMode(APMPlaneMode::QRTL,            true),
         APMPlaneMode(APMPlaneMode::QAUTOTUNE,       true),
         APMPlaneMode(APMPlaneMode::QACRO,           true),
+        APMPlaneMode(APMPlaneMode::THERMAL,         true),
     });
 
     if (!_remapParamNameIntialized) {
diff --git a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.h b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.h
index 296a45b34b45842472999c65c12f0e8763d695b9..6d3c8b957b8b6c37374258829d4e948a67906352 100644
--- a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.h
+++ b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.h
@@ -44,6 +44,7 @@ public:
         QRTL          = 21,
         QAUTOTUNE     = 22,
         QACRO         = 23,
+        THERMAL       = 24,
     };
 
     APMPlaneMode(uint32_t mode, bool settable);