init

OledDisplay.h

@@ -0,0 +1,72 @@
+#ifndef OledDisplay_h
+#define OledDisplay_h
+
+#include <Adafruit_SSD1306.h>
+#include <Adafruit_GFX.h>
+#include <Arduino.h>
+
+#define OLED_RESET -1     // Reset pin # (or -1 if sharing Arduino reset pin)
+#define SCREEN_WIDTH 128  // OLED display width, in pixels
+#define SCREEN_HEIGHT 64  // OLED display height, in pixels
+
+class OledDisplay {
+  private: 
+    Adafruit_SSD1306 display{SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET};
+    int currentLine = 0;
+
+  public:
+    void setup();
+    void write(String msg);
+    void clear();
+    void droneMessage(String msg);
+};
+
+void OledDisplay::setup() {
+  // display module
+  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);  // I2C address = 0x3C
+  display.setTextSize(1);
+  display.setTextColor(WHITE);
+  display.setCursor(0, 0);
+  display.clearDisplay();
+  display.print("Loading");
+  display.display();
+  for (int i = 0; i < 3; i++) {
+    display.print(".");
+  display.display();
+    delay(500);
+  }
+  display.clearDisplay();
+  delay(10);
+  write("Display is ready");
+}
+
+void OledDisplay::write(String msg) {
+  if (currentLine >= 60) {
+    currentLine = 0;
+  }
+  display.setCursor(0, currentLine);
+  display.print(msg);
+  display.display();
+  currentLine+=10;
+}
+
+void OledDisplay::clear() {
+  display.clearDisplay();
+  display.setCursor(0, 0);
+  currentLine = 0;
+}
+
+void OledDisplay::droneMessage(String msg) {
+  clear();
+  const char delimiter[] = "|";
+
+  char* token = strtok(msg.c_str(), delimiter);
+
+  while (token != NULL) {
+    Serial.println(token);
+    write(String(token));
+    token=strtok(NULL, delimiter);
+  }
+}
+
+#endif