#include <Servo.h>
Servo servo1;

int encoderPosition = 170;
int lastValue;
int currentValue;
int buttonState;

int encoderCLKpin = 2;
int encoderDTpin = 3;

void setup() {
  pinMode(encoderCLKpin, INPUT);
  pinMode(encoderDTpin, INPUT);
  pinMode(4, INPUT_PULLUP);
  pinMode(5, OUTPUT);
  lastValue = digitalRead(encoderCLKpin);

  servo1.attach(6);

  Serial.begin(9600);
  Serial.println("BEGIN");
  Serial.println();
}

void loop() {
  currentValue = digitalRead(encoderCLKpin);
  if (currentValue != lastValue) {
    if (digitalRead(encoderDTpin) != currentValue)  //Rotating Clockwise
    {
      encoderPosition++;
      if (encoderPosition > 180)
      {
      (encoderPosition = 180);
      }

      Serial.println("Clockwise");
      Serial.println(encoderPosition);
    }

    else
    {
      encoderPosition--;
      if (encoderPosition < 0)
      {
      (encoderPosition = 0);
      }
      Serial.println("Counterclockwise");
      Serial.println(encoderPosition);
    }
  }
  servo1.write(encoderPosition);
  lastValue = currentValue;

  buttonState = (digitalRead(4));
  if (buttonState == LOW)
  {
  digitalWrite(5, HIGH);
  (encoderPosition = 90);
  }
  else
  {
  digitalWrite(5, LOW);
  }

  
}