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

Adafruit_SSD1306 display = Adafruit_SSD1306(128, 32, &Wire);

int setPoint = 69;

#define BUTTON_A  31
#define BUTTON_B  30
#define BUTTON_C  27

void setup() {
  Serial.begin(9600);

  Serial.println("OLED FeatherWing test");
  // SSD1306_SWITCHCAPVCC = generate display voltage from 3.3V internally
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C); // Address 0x3C for 128x32

  Serial.println("OLED begun");

  // Show image buffer on the display hardware.
  // Since the buffer is intialized with an Adafruit splashscreen
  // internally, this will display the splashscreen.
  display.display();
  delay(1000);

  // Clear the buffer.
  display.clearDisplay();
  display.display();

  Serial.println("IO test");

  pinMode(BUTTON_A, INPUT_PULLUP);
  pinMode(BUTTON_B, INPUT_PULLUP);
  pinMode(BUTTON_C, INPUT_PULLUP);

  // text display tests
  display.setTextSize(3);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(0,0);
  //display.print("Connecting to SSID\n'adafruit':");
  //display.print("connected!");
  //display.println("IP: 10.0.1.23");
  display.println("Boot");
  display.setCursor(0,0);
  display.display(); // actually display all of the above
}

void loop() {

  if (!digitalRead(BUTTON_A)) {
    setPoint++;
  } else if (!digitalRead(BUTTON_C)) {
    setPoint--;
  } else if (!digitalRead(BUTTON_B)) {
    ; // GO!
  }
  
  delay(50);

  display.clearDisplay();

  display.setCursor(0,0);
  display.print(setPoint);
  display.println(" PSI");
  
  yield();
  display.display();
}