#include <Adafruit_SSD1306.h>
#include <Adafruit_GFX.h>

#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     4 // Reset pin # (or -1 if sharing Arduino reset pin)
#define SCREEN_ADDRESS 0x3C ///< See datasheet for Address; 0x3D for 128x64, 0x3C for 128x32

const int buttonPin1 = 2;
const int buttonPin2 = 4;
int buttonState1 = 0;
int buttonState2 = 0;

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

void setup() {
  pinMode(buttonPin1, INPUT_PULLUP);
  pinMode(buttonPin2, INPUT_PULLUP);

  // SSD1306_SWITCHCAPVCC = generate display voltage from 3.3V internally
  if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
      Serial.println("DEBUG: setupDisplay(): Error! SSD1306 allocation failed");
      return false;
  } else {
      Serial.println("DEBUG: setupDisplay(), Display Initialized");
      return true;         
      }
  display.clearDisplay();
  display.display();
}

void displayData(int buttPressed) {
  Serial.println(buttPressed);
  switch(buttPressed ) {
    case 2:
      display.clearDisplay();
      display.setTextSize(2);
      display.setTextColor(WHITE);
      display.setCursor(0, 0);
      display.println("Button L ");

      display.setTextSize(2);
      display.print("23.4");
      display.print(" "); display.print((char)247); display.println("C");
      display.display();
      break;
    case 3:
      display.clearDisplay();
      display.setTextSize(2);
      display.setTextColor(WHITE);
      display.setCursor(0, 0);
      display.println("Button R ");

      display.setTextSize(2);
      display.print("23.4");
      display.print(" "); display.print((char)247); display.println("C");
      display.display();
      break;
    default:
      break;
  }
}

void loop() {
    buttonState1 = digitalRead(buttonPin1);
    if (buttonState1 == HIGH) {
      displayData(2);
    } else {
      displayData(0);
    }
    // buttonState2 = digitalRead(buttonPin2);
    // if (buttonState2 == HIGH) {
    //   displayData(3);
    // } else {
    //   displayData(0); 
    // }
}