/*
  Blink

  Turns an LED on for one second, then off for one second, repeatedly.

  Most Arduinos have an on-board LED you can control. On the UNO, MEGA and ZERO
  it is attached to digital pin 13, on MKR1000 on pin 6. LED_BUILTIN is set to
  the correct LED pin independent of which board is used.
  If you want to know what pin the on-board LED is connected to on your Arduino
  model, check the Technical Specs of your board at:
  https://www.arduino.cc/en/Main/Products

  modified 8 May 2014
  by Scott Fitzgerald
  modified 2 Sep 2016
  by Arturo Guadalupi
  modified 8 Sep 2016
  by Colby Newman

  This example code is in the public domain.

  https://www.arduino.cc/en/Tutorial/BuiltInExamples/Blink
*/

#include <Wire.h>
#include <Adafruit_SSD1306.h>
#include <Adafruit_Sensor.h>

#define SCREEN_WIDTH 128  // OLED display width, in pixels
#define SCREEN_HEIGHT 32  // OLED display height, in pixels

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire);

// #define Huzzah
// #define Clone


#define BOTTOM_GREEN 33
#define TOP_RED 4
#define BLUE 32



// the setup function runs once when you press reset or power the board
void setup() {
  // initialize digital pin LED_BUILTIN as an output.
  Serial.begin(115200);
  Wire.begin();  // Initialize I2C communication
  // SSD1306_SWITCHCAPVCC = generate display voltage from 3.3V internally
  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {  // Address 0x3C for 128x32
    Serial.println(F("SSD1306 allocation failed"));
    for (;;)
      ;  // Don't proceed, loop forever
  }
  display.display(); // Display AdaFruit Logo
  delay(2000);  // Pause for 2 seconds
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setRotation(0);
  display.setCursor(0, 0);

  pinMode(TOP_RED, OUTPUT);
  pinMode(BOTTOM_GREEN, OUTPUT);
  digitalWrite(TOP_RED, LOW);
  digitalWrite(BOTTOM_GREEN, LOW);
}

// the loop function runs over and over again forever
void loop() {
  digitalWrite(TOP_RED, HIGH);  // turn the LED on (HIGH is the voltage level)
  Serial.println("TOP_RED LED ON");
  display.println("TOP_RED LED ON");  // Print the color value on OLED display
  display.display();                  // Update the OLED display     //Reset for the next message
  delay(2000);                 // wait for a 2 seconds

  digitalWrite(TOP_RED, LOW);  // turn the LED off by making the voltage LOW
  Serial.println("TOP_RED LED OFF");
  display.println("TOP_RED LED OFF");  // Print the color value on OLED display
  display.display();                   // Update the OLED display     //Reset for the next message
  delay(2000);                         // wait for 2 seconds

  digitalWrite(BOTTOM_GREEN, HIGH);    // turn the LED on (HIGH is the voltage level)
  Serial.println("BOTTOM_GREEN LED ON");
  display.println("BOTTOM_GREEN LED ON");  // Print the color value on OLED display
  display.display();                       // Update the OLED display     //Reset for the next message
  delay(2000);                             // wait for 2 seconds

  digitalWrite(BOTTOM_GREEN, LOW);         // turn the LED off by making the voltage LOW
  Serial.println("BOTTOM_GREEN LED OFF");
  display.println("BOTTOM_GREEN LED OFF");  // Print the color value on OLED display
  display.display();                        // Update the OLED display     //Reset for the next message
  delay(2000);                              // wait for 2 seconds

  display.clearDisplay();   // Clear the buffer
  display.setCursor(0, 0);  // Set cursor to the top-left corner

}