Power saving mode

src/MF_CustomDevice/CustomDevice.cpp

@@ -6,6 +6,9 @@
     Normally nothing has to be changed in this file
     It handles one or multiple custom devices
 ********************************************************************************** */
+
+#define MESSAGEID_POWERSAVINGMODE -2
+
 namespace CustomDevice
 {
     MFCustomDevice *customDevice;
@@ -84,4 +87,20 @@ namespace CustomDevice
         customDevice[device].set(messageID, output);      // send the string to your custom device
     }
 
-} // end of namespace
+    /* **********************************************************************************
+        This function is called if the status of the PowerSavingMode changes.
+        'state' is true if PowerSaving is enabled
+        'state' is false if PowerSaving is disabled
+        MessageID '-2' for the custom device  for PowerSavingMode
+    ********************************************************************************** */
+    void PowerSave(bool state)
+    {
+        for (uint8_t i = 0; i < customDeviceRegistered; ++i) {
+            if (state)
+                customDevice[i].set(MESSAGEID_POWERSAVINGMODE, "1");
+            else
+                customDevice[i].set(MESSAGEID_POWERSAVINGMODE, "0");
+        }
+    }
+
+} // end of namespace

src/MF_CustomDevice/CustomDevice.h

@@ -7,4 +7,5 @@ namespace CustomDevice
     void Clear();
     void update();
     void OnSet();
+    void PowerSave(bool state);
 }

src/mobiflight.cpp

@@ -120,6 +120,9 @@ void SetPowerSavingMode(bool state)
 #if MF_STEPPER_SUPPORT == 1
     Stepper::PowerSave(state);
 #endif
+#if MF_CUSTOMDEVICE_SUPPORT == 1
+    CustomDevice::PowerSave(state);
+#endif
 
 #ifdef DEBUG2CMDMESSENGER
     if (state)