From 17fb26527b004c731b896444e56330a7ecde1441 Mon Sep 17 00:00:00 2001
From: JbLb <jerome@jblb.net>
Date: Thu, 2 Jan 2020 23:26:21 +0100
Subject: [PATCH] display infos on OLED

---
 src/hoverserial.ino | 29 ++++++++++++++++++++++++-----
 1 file changed, 24 insertions(+), 5 deletions(-)

diff --git a/src/hoverserial.ino b/src/hoverserial.ino
index 965dba2..88f8203 100644
--- a/src/hoverserial.ino
+++ b/src/hoverserial.ino
@@ -92,8 +92,12 @@ void setup()
 	display.clearDisplay();
 	display.display();
 	display.setCursor(0, 0);
-    display.println("Hello World!");
-    
+	display.setTextSize(1); // Draw 1X-scale text
+	display.setTextColor(SSD1306_WHITE);
+	display.println("Hoverboard Serial");
+	display.println("v1.0");
+	display.display();
+
 	Serial1.begin(HOVER_SERIAL_BAUD);  // RX, TX from arduino to TX RX on hoverboard board. ! be carreful 3v3 
   	pinMode(LED_BUILTIN, OUTPUT);
 
@@ -191,9 +195,24 @@ void loop(void)
 	// Check for new received data
 	Receive();
 
-  // Calculate test command signal
-  iTest += 10;
-  if (iTest > iTestMax) iTest = -iTestMax;
+	// Send commands
+	if (iTimeSend > timeNow)
+		return;
+	iTimeSend = timeNow + TIME_SEND;
+	Send(0, abs(iTest));
+	display.setCursor(0, 30);
+	display.setTextSize(1); // Draw 1X-scale text
+	display.setTextColor(SSD1306_WHITE);
+	display.print("Speed : ");
+	display.setCursor(40, 30);
+	display.print("    ");
+	display.setCursor(40, 30);
+    display.print(iTest);
+	display.display();
+	// Calculate test command signal
+	iTest += 10;
+	if (iTest > iTestMax)
+		iTest = -iTestMax;
 
 	// Blink the LED
 	digitalWrite(LED_BUILTIN, (timeNow % 2000) < 1000);