diff --git a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
index 88fd034571ad081c30971d09bd78a02116b56b4e..142f0f75a1a800d61741c0e7803ff90158c723b3 100644
--- a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
+++ b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.cc
@@ -50,6 +50,7 @@ const char* PX4FirmwarePlugin::_rattitudeFlightMode =   "Rattitude";
 const char* PX4FirmwarePlugin::_followMeFlightMode =    "Follow Me";
 const char* PX4FirmwarePlugin::_rtgsFlightMode =        "Return to Groundstation";
 const char* PX4FirmwarePlugin::_readyFlightMode =       "Ready";
+const char* PX4FirmwarePlugin::_simpleFlightMode =      "Simple";
 
 /// Tranlates from PX4 custom modes to flight mode names
 
@@ -61,6 +62,7 @@ static const struct Modes2Name rgModes2Name[] = {
     { PX4_CUSTOM_MAIN_MODE_RATTITUDE,   0,                                      PX4FirmwarePlugin::_rattitudeFlightMode,    true,   true,   true },
     { PX4_CUSTOM_MAIN_MODE_ALTCTL,      0,                                      PX4FirmwarePlugin::_altCtlFlightMode,       true,   true,   true },
     { PX4_CUSTOM_MAIN_MODE_POSCTL,      0,                                      PX4FirmwarePlugin::_posCtlFlightMode,       true,   true,   true },
+    { PX4_CUSTOM_MAIN_MODE_SIMPLE,      0,                                      PX4FirmwarePlugin::_simpleFlightMode,       true,   false,  true },
     { PX4_CUSTOM_MAIN_MODE_AUTO,        PX4_CUSTOM_SUB_MODE_AUTO_LOITER,        PX4FirmwarePlugin::_holdFlightMode,         true,   true,   true },
     { PX4_CUSTOM_MAIN_MODE_AUTO,        PX4_CUSTOM_SUB_MODE_AUTO_MISSION,       PX4FirmwarePlugin::_missionFlightMode,      true,   true,   true },
     { PX4_CUSTOM_MAIN_MODE_AUTO,        PX4_CUSTOM_SUB_MODE_AUTO_RTL,           PX4FirmwarePlugin::_rtlFlightMode,          true,   true,   true },
diff --git a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.h b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.h
index 718f8b7f4028270dfd38463c43e7355a6c2763ca..b30dfa19246b7e99a3a89464fc916d2ba8af59ff 100644
--- a/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.h
+++ b/src/FirmwarePlugin/PX4/PX4FirmwarePlugin.h
@@ -81,6 +81,7 @@ public:
     static const char* _landingFlightMode;
     static const char* _rtgsFlightMode;
     static const char* _followMeFlightMode;
+    static const char* _simpleFlightMode;
 
 private:
     void _handleAutopilotVersion(Vehicle* vehicle, mavlink_message_t* message);
diff --git a/src/FirmwarePlugin/PX4/px4_custom_mode.h b/src/FirmwarePlugin/PX4/px4_custom_mode.h
index b3e9de3aba25d001d04a95c0983480a600ea9a48..6569ce6e0b092f6fb98b1804b77d9e98759ee4fc 100644
--- a/src/FirmwarePlugin/PX4/px4_custom_mode.h
+++ b/src/FirmwarePlugin/PX4/px4_custom_mode.h
@@ -50,7 +50,8 @@ enum PX4_CUSTOM_MAIN_MODE {
 	PX4_CUSTOM_MAIN_MODE_ACRO,
 	PX4_CUSTOM_MAIN_MODE_OFFBOARD,
 	PX4_CUSTOM_MAIN_MODE_STABILIZED,
-	PX4_CUSTOM_MAIN_MODE_RATTITUDE
+    PX4_CUSTOM_MAIN_MODE_RATTITUDE,
+    PX4_CUSTOM_MAIN_MODE_SIMPLE
 };
 
 enum PX4_CUSTOM_SUB_MODE_AUTO {