From 83ae6cc9a22fcd37cc995045e121e5b460ec9bda Mon Sep 17 00:00:00 2001
From: Romain Goyet <romain.goyet@numworks.com>
Date: Mon, 6 Mar 2017 14:02:10 +0100
Subject: [PATCH] [apps/hwtest] Support turning LED, Display and Backlight ON
 or OFF

Change-Id: If39e034149cc8408db3e0878b9807f6e7a8e1ae3
---
 apps/hwtest/lowlevel/lowlevel.cpp | 49 ++++++++++++++++++++++++++++---
 1 file changed, 45 insertions(+), 4 deletions(-)

diff --git a/apps/hwtest/lowlevel/lowlevel.cpp b/apps/hwtest/lowlevel/lowlevel.cpp
index ff466c7cb..7ff648629 100644
--- a/apps/hwtest/lowlevel/lowlevel.cpp
+++ b/apps/hwtest/lowlevel/lowlevel.cpp
@@ -1,5 +1,8 @@
 #include <stddef.h>
 #include <ion.h>
+#include <ion/src/device/backlight.h>
+#include <ion/src/device/display.h>
+#include <ion/src/device/led.h>
 #include <poincare.h>
 
 typedef void (*CommandFunction)(const char * input);
@@ -72,7 +75,10 @@ void CommandList::dispatch(const char * command) const {
   Ion::Console::writeLine("NOT_FOUND");
 }
 
+static const char * sOK = "OK";
 static const char * sSyntaxError = "SYNTAX_ERROR";
+static const char * sON = "ON";
+static const char * sOFF = "OFF";
 
 void command_ping(const char * input) {
   if (input != nullptr) {
@@ -111,7 +117,17 @@ static inline uint32_t hexNumber(const char * s) {
 }
 
 void command_led(const char * input) {
-  // Input must be of the form "0xAABBCC"
+  // Input must be of the form "0xAABBCC" or "ON" or "OFF"
+  if (strcmp(input, sON) == 0) {
+    Ion::LED::Device::init();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
+  if (strcmp(input, sOFF) == 0) {
+    Ion::LED::Device::shutdown();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
   if (input == nullptr || input[0] != '0' || input[1] != 'x' || !isHex(input[2]) ||!isHex(input[3]) || !isHex(input[4]) || !isHex(input[5]) || !isHex(input[6]) || !isHex(input[7]) || input[8] != NULL) {
     Ion::Console::writeLine(sSyntaxError);
     return;
@@ -119,18 +135,42 @@ void command_led(const char * input) {
   uint32_t hexColor = hexNumber(input+2);
   KDColor ledColor = KDColor::RGB24(hexColor);
   Ion::LED::setColor(ledColor);
-  Ion::Console::writeLine("OK");
+  Ion::Console::writeLine(sOK);
+}
+
+void command_display(const char * input) {
+  if (strcmp(input, sON) == 0) {
+    Ion::Display::Device::init();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
+  if (strcmp(input, sOFF) == 0) {
+    Ion::Display::Device::shutdown();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
+  Ion::Console::writeLine(sSyntaxError);
 }
 
 void command_backlight(const char * input) {
-  // Input must be of the form "0xAA"
+  // Input must be of the form "0xAA" or "ON" or "OFF"
+  if (strcmp(input, sON) == 0) {
+    Ion::Backlight::Device::init();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
+  if (strcmp(input, sOFF) == 0) {
+    Ion::Backlight::Device::shutdown();
+    Ion::Console::writeLine(sOK);
+    return;
+  }
   if (input == nullptr || input[0] != '0' || input[1] != 'x' || !isHex(input[2]) ||!isHex(input[3]) || input[4] != NULL) {
     Ion::Console::writeLine(sSyntaxError);
     return;
   }
   uint32_t brightness = hexNumber(input+2);
   Ion::Backlight::setBrightness(brightness);
-  Ion::Console::writeLine("OK");
+  Ion::Console::writeLine(sOK);
 }
 
 void command_adc(const char * input) {
@@ -179,6 +219,7 @@ constexpr CommandHandler handles[] = {
   CommandHandler("ADC", command_adc),
   CommandHandler("CHARGE", command_charge),
   CommandHandler("KEYBOARD", command_keyboard),
+  CommandHandler("DISPLAY", command_display),
   CommandHandler(nullptr, nullptr)
 };
 constexpr const CommandList sCommandList = CommandList(handles);