#include <Servo.h>
#define RED_BUTTON_PIN 3
#define BLUE_BUTTON_PIN A1
#define WHITE_BUTTON_PIN A4
#define BLACK_BUTTON_PIN A2
#define GREEN_BUTTON_PIN A3
#define RED_LED_PIN 2
#define GREEN_LED_PIN 10
#define SWITCH_PIN 12
#define DIAL_PIN A0
#define RIGHTSERVO_PIN 9
#define LEFTSERVO_PIN 6

Servo rightServo;
Servo leftServo;

int rightServoPos = 90;
int leftServoPos = 90;


void setup() {

  rightServo.attach(RIGHTSERVO_PIN);
  leftServo.attach(LEFTSERVO_PIN);
  rightServo.write(rightServoPos);
  leftServo.write(leftServoPos);
  pinMode(SWITCH_PIN, INPUT);
  pinMode(RED_LED_PIN, OUTPUT);
  pinMode(GREEN_LED_PIN, OUTPUT);
  pinMode(RED_BUTTON_PIN, INPUT_PULLUP);
  pinMode(BLUE_BUTTON_PIN, INPUT_PULLUP);
  pinMode(WHITE_BUTTON_PIN, INPUT_PULLUP);
  pinMode(BLACK_BUTTON_PIN, INPUT_PULLUP);
  pinMode(GREEN_BUTTON_PIN, INPUT_PULLUP);
}


void loop() {
  int val, sliderSwitch;

  sliderSwitch = digitalRead(SWITCH_PIN);
  if (sliderSwitch == HIGH) {
    digitalWrite(GREEN_LED_PIN, HIGH);
    digitalWrite(RED_LED_PIN, LOW);

    val = analogRead(DIAL_PIN);
    leftServoPos = map(val, 0, 1023, 0, 180);
    rightServoPos =   180 - leftServoPos ;
    delay(25);

  }  else if (sliderSwitch == LOW) {

    digitalWrite(GREEN_LED_PIN, LOW);
    digitalWrite(RED_LED_PIN, HIGH);

    if (digitalRead(RED_BUTTON_PIN) == LOW) {
      rightServoPos = 90;
      leftServoPos = 90;
      delay(100);
    }

    if (digitalRead(GREEN_BUTTON_PIN) == LOW) {
      rightServoPos = rightServoPos + 1;
      leftServoPos = leftServoPos - 1;
      delay(10);
    }
    
    if (digitalRead(BLUE_BUTTON_PIN) == LOW) {
      rightServoPos = rightServoPos - 1;
      leftServoPos = leftServoPos + 1;
      delay(10);
    }

    if (digitalRead(WHITE_BUTTON_PIN) == LOW) {
      rightServoPos = rightServoPos - 1;
      leftServoPos = leftServoPos - 1;
      delay(10);
    } 
    
    if (digitalRead(BLACK_BUTTON_PIN) == LOW) {
      rightServoPos = rightServoPos + 1;
      leftServoPos = leftServoPos + 1;
      delay(10);
    }
  }

  rightServoPos = constrain(rightServoPos, 0, 180);
  leftServoPos = constrain(leftServoPos, 0, 180);
  rightServo.write(rightServoPos);
  leftServo.write(leftServoPos);

}