display setup

src/hoverserial.ino

@@ -38,6 +38,11 @@
 #define SPEED_MAX_TEST      300         // [-] Maximum speed for testing
 //#define DEBUG_RX                        // [-] Debug received data. Prints all bytes to serial (comment-out to disable)
 
+#include <Wire.h>
+#include <Adafruit_GFX.h>
+#include <Adafruit_SSD1306.h>
+
+
 // #include <SoftwareSerial.h>
 // SoftwareSerial HoverSerial(2,3); 		    // RX, TX
 
@@ -71,9 +76,19 @@ typedef struct{
 SerialFeedback Feedback;
 SerialFeedback NewFeedback;
 
+#define SCREEN_WIDTH 128 // OLED display width, in pixels
+#define SCREEN_HEIGHT 64 // OLED display height, in pixels
+
+// Declaration for an SSD1306 display connected to I2C (SDA, SCL pins)
+#define OLED_RESET     -1 // Reset pin # (or -1 if sharing Arduino reset pin)
+Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);
+
 // ########################## SETUP ##########################
 void setup() 
 {
+	
+	display.begin(SSD1306_SWITCHCAPVCC, 0x3C);  // initialize with the I2C addr 0x3D (for the 128x64) 
+	
 	Serial1.begin(HOVER_SERIAL_BAUD);  // RX, TX from arduino to TX RX on hoverboard board. ! be carreful 3v3 
   	pinMode(LED_BUILTIN, OUTPUT);