From 0f1582809361bd7aeac879afcd86d59bc520a901 Mon Sep 17 00:00:00 2001
From: Damjan Adamic <projectkk2glider@gmail.com>
Date: Mon, 6 Apr 2015 18:22:34 +0200
Subject: [PATCH] X9E: turn off top lcd and both backlights when powering off

---
 radio/src/targets/taranis/board_taranis.h    | 1 +
 radio/src/targets/taranis/hal.h              | 1 +
 radio/src/targets/taranis/top_lcd_driver.cpp | 7 +++++++
 radio/src/tasks_arm.cpp                      | 4 ++++
 4 files changed, 13 insertions(+)

diff --git a/radio/src/targets/taranis/board_taranis.h b/radio/src/targets/taranis/board_taranis.h
index d3846c275..49b838d42 100644
--- a/radio/src/targets/taranis/board_taranis.h
+++ b/radio/src/targets/taranis/board_taranis.h
@@ -338,6 +338,7 @@ void bt_wakeup(void);
 // Top LCD driver
 #if defined(REV9E)
 void topLcdInit(void);
+void topLcdOff();
 void topLcdRefreshStart(void);
 void topLcdRefreshEnd(void);
 void setTopFirstTimer(uint32_t value);
diff --git a/radio/src/targets/taranis/hal.h b/radio/src/targets/taranis/hal.h
index 605201d32..d362df4cf 100644
--- a/radio/src/targets/taranis/hal.h
+++ b/radio/src/targets/taranis/hal.h
@@ -440,6 +440,7 @@
   #define DATA_HIGH                     GPIO_VA->BSRRL = PIN_VA_DATA
   #define DATA_LOW                      GPIO_VA->BSRRH = PIN_VA_DATA
   #define VA_BL_ON                      GPIO_VA->BSRRL = PIN_VA_BL
+  #define VA_BL_OFF                     GPIO_VA->BSRRH = PIN_VA_BL
 #endif
 
 #endif
diff --git a/radio/src/targets/taranis/top_lcd_driver.cpp b/radio/src/targets/taranis/top_lcd_driver.cpp
index a6da9b6e3..dfe434186 100755
--- a/radio/src/targets/taranis/top_lcd_driver.cpp
+++ b/radio/src/targets/taranis/top_lcd_driver.cpp
@@ -261,6 +261,13 @@ void topLcdInit()
   topLcdRefreshEnd();
 }
 
+void topLcdOff()
+{
+  VA_BL_OFF;
+  topLcdRefreshStart();
+  topLcdRefreshEnd();
+}
+
 void setTopFirstTimer(uint32_t value)
 {
   div_t qr = div(value, 60);
diff --git a/radio/src/tasks_arm.cpp b/radio/src/tasks_arm.cpp
index a0a0b5c40..4b7edb2f4 100644
--- a/radio/src/tasks_arm.cpp
+++ b/radio/src/tasks_arm.cpp
@@ -179,6 +179,10 @@ void menusTask(void * pdata)
   lcd_clear();
   lcdRefresh();
   lcdOff();
+  BACKLIGHT_OFF();
+#if defined(REV9E)
+  topLcdOff();
+#endif
 
 #if !defined(SIMU)
   SysTick->CTRL = 0; // turn off systick