1 files changed, 6 insertions, 1 deletions

diff --git a/firmware/target/coldfire/mpio/hd200/backlight-hd200.c b/firmware/target/coldfire/mpio/hd200/backlight-hd200.c
index 783376c91e..ef698b2a4a 100644
--- a/firmware/target/coldfire/mpio/hd200/backlight-hd200.c
+++ b/firmware/target/coldfire/mpio/hd200/backlight-hd200.c
@@ -27,13 +27,15 @@
 #include "backlight-target.h"
 #include "lcd.h"
 
-static bool _backlight_on = false;
+static bool _backlight_on = true;
 static int _brightness = DEFAULT_BRIGHTNESS_SETTING;
 
 /* Returns the current state of the backlight (true=ON, false=OFF). */
 bool _backlight_init(void)
 {
+#ifdef BOOTLOADER
     and_l(~(1<<28),&GPIO_OUT);
+#endif
     or_l((1<<28),&GPIO_FUNCTION);
     or_l((1<<28),&GPIO_ENABLE);
     return true;
@@ -61,6 +63,9 @@ void _backlight_set_brightness(int val)
 {
     unsigned char i;
 
+    if( _brightness == val && _backlight_on == true )
+        return;
+
     and_l(~(1<<28),&GPIO_OUT);
     sleep(4);