#include <Adafruit_SSD1306.h>
#include <SimpleRotary.h>

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET -1
#define SCREEN_ADDRESS 0x3C

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

#define BUTTON1 2
#define BUTTON2 3

#define ENCODER_CLK1 5
#define ENCODER_DT1  4

int b1Value;
int b2Value;
int b1ValueOld = 0;
int b2ValueOld = 0;
int lastClk = HIGH;
int newClk;
int xPos=0;
int yPos=0;

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

  if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); 
  }
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(0,0);
  display.print("BOOTING");
  display.display();
  delay(2000);
  display.clearDisplay();
  display.display();

  pinMode(BUTTON1, INPUT_PULLUP);
  pinMode(BUTTON2, INPUT_PULLUP);
  pinMode(ENCODER_CLK1, INPUT);
  pinMode(ENCODER_DT1, INPUT);
}

void loop() {
  b1Value = digitalRead(BUTTON1);
  b2Value = digitalRead(BUTTON2);
  newClk = digitalRead(ENCODER_CLK1);
  if (newClk != lastClk)
  {
    lastClk = newClk;
    int dtValue = digitalRead(ENCODER_DT1);
    if (newClk == LOW && dtValue == HIGH) {
      ++xPos;
      if (xPos>128)
      {
        xPos=128;
      }
      Serial.println(xPos);
    }
    if (newClk == LOW && dtValue == LOW) {
      --xPos;
      if (xPos<0)
      {
        xPos=0;
      }
      Serial.println(xPos);
    }
  }  
  
}