2 files changed, 24 insertions, 6 deletions

diff --git a/firmware/target/arm/olympus/mrobe-100/backlight-mr100.c b/firmware/target/arm/olympus/mrobe-100/backlight-mr100.c
index f5a7370590..07c97dfb58 100644
--- a/firmware/target/arm/olympus/mrobe-100/backlight-mr100.c
+++ b/firmware/target/arm/olympus/mrobe-100/backlight-mr100.c
@@ -17,19 +17,26 @@
  *
  ****************************************************************************/
 
-#include "backlight-target.h"
+#include "config.h"
 #include "system.h"
+#include "backlight-target.h"
 
 #define MIN_BRIGHTNESS 0x80ff08ff
 
 static const int log_brightness[12] = {0,4,8,12,20,28,40,60,88,124,176,255};
 
-void _backlight_on(void)
+/* Returns the current state of the backlight (true=ON, false=OFF). */
+bool _backlight_init(void)
+{
+    return (GPO32_ENABLE & 0x1000000) ? true : false;
+}
+
+void _backlight_hw_on(void)
 {
     GPO32_ENABLE |= 0x1000000;
 }
 
-void _backlight_off(void)
+void _backlight_hw_off(void)
 {
     GPO32_ENABLE &= ~0x1000000;
 }
diff --git a/firmware/target/arm/olympus/mrobe-100/backlight-target.h b/firmware/target/arm/olympus/mrobe-100/backlight-target.h
index 7b4787fec3..9aeac85541 100644
--- a/firmware/target/arm/olympus/mrobe-100/backlight-target.h
+++ b/firmware/target/arm/olympus/mrobe-100/backlight-target.h
@@ -20,9 +20,20 @@
 #ifndef BACKLIGHT_TARGET_H
 #define BACKLIGHT_TARGET_H
 
-#define _backlight_init() true
-void _backlight_on(void);
-void _backlight_off(void);
+bool _backlight_init(void); /* Returns backlight current state (true=ON). */
+void _backlight_hw_on(void);
+void _backlight_hw_off(void);
+
+#ifdef BOOTLOADER
+#define _backlight_on() _backlight_hw_on()
+#define _backlight_off() _backlight_hw_off()
+#else
+#define _backlight_on_isr() _backlight_hw_on()
+#define _backlight_off_isr() _backlight_hw_off()
+#define _backlight_on_normal() _backlight_hw_on()
+#define _backlight_off_normal() _backlight_hw_off()
+#define _BACKLIGHT_FADE_BOOST
+#endif
 
 /* Button lights are controlled by GPIOA_OUTPUT_VAL */
 #define BUTTONLIGHT_PLAY     0x01