display infos on OLED

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
+	// Send commands
-  iTest += 10;
+	if (iTimeSend > timeNow)
-  if (iTest > iTestMax) iTest = -iTestMax;
+		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);