#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Servo.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)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

#define ENCODER_CLK 2
#define ENCODER_DT  3

Servo myservo;

const int rdiv = A7;
int vdiv = 0;
int cont = 0;
int val = 0;

void setup() {
  // put your setup code here, to run once:
  myservo.attach(5);
  pinMode(ENCODER_CLK, INPUT);
  pinMode(ENCODER_DT, INPUT);
  attachInterrupt(digitalPinToInterrupt(ENCODER_CLK), readEncoder, FALLING);
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(0, 0);
  display.print("WAGOO WAGOO");
  display.setCursor(0, 10);
  display.print("By: Blue31");
  display.display();
  pinMode(rdiv, INPUT);
  delay(1000);
  display.clearDisplay();
  display.display();
}

void readEncoder() {
  int dtValue = digitalRead(ENCODER_DT);
  if (dtValue == HIGH) {
    cont += 2;
  }
  if (dtValue == LOW) {
    cont -= 2;
  }
}

void loop() {
  // put your main code here, to run repeatedly:
  vdiv = analogRead(rdiv);
  val = map(cont, 0, 1023, 0, 180);
  myservo.write(val);
  display.clearDisplay();
  display.setTextSize(2);
  display.setCursor(0, 0);
  display.print(vdiv);
  display.print(" val");
  display.setCursor(0, 20);
  display.print(cont);
  display.setCursor(0, 40);
  display.print(val);
  display.print(" DEG");
  display.display();
  delay(100);
}