From 7d85d40f680138dfe9645d84389319441a92b13d Mon Sep 17 00:00:00 2001
From: Damjan Adamic <projectkk2glider@gmail.com>
Date: Sat, 5 Jul 2014 17:08:56 +0200
Subject: [PATCH] Fixes #1452 - Backlight simulation

---
 radio/src/targets/simu/simpgmspace.cpp | 16 ++++++++++++++--
 1 file changed, 14 insertions(+), 2 deletions(-)

diff --git a/radio/src/targets/simu/simpgmspace.cpp b/radio/src/targets/simu/simpgmspace.cpp
index c72a1c6c7..037761dcc 100644
--- a/radio/src/targets/simu/simpgmspace.cpp
+++ b/radio/src/targets/simu/simpgmspace.cpp
@@ -684,7 +684,19 @@ void unlockFlash() { }
 void lockFlash() { }
 void writeFlash(uint32_t *address, uint32_t *buffer) { SIMU_SLEEP(100); }
 uint32_t isBootloaderStart(const void *block) { return 1; }
-void turnBacklightOn(uint8_t level, uint8_t color) { }
-void turnBacklightOff(void) { }
+#if defined(REVPLUS)
+void turnBacklightOn(uint8_t level, uint8_t color)
+{
+  TIM4->CCR4 = (100-level)*color;
+  TIM4->CCR2 = (100-level)*(100-color);
+}
+
+void turnBacklightOff(void)
+{
+  TIM4->CCR4 = 0;
+  TIM4->CCR2 = 0;
+}
+#endif
+
 #endif