#include <Servo.h>
#include <Arduino.h>

//constants for buttons and led
const int buttonA = 13;
const int buttonB = 12;
const int buttonC = 8;
const int buttonD = 7;

const int ledYellow = 5;
const int ledBlue = 6;
const int ledRed = 9;
const int ledGreen = 10;

Servo angle;
  
void setup() {
  //set led to output
  pinMode(ledYellow, OUTPUT);
  pinMode(ledBlue, OUTPUT);
  pinMode(ledRed, OUTPUT);
  pinMode(ledGreen, OUTPUT);

//set buttons to input
  pinMode(buttonA, INPUT);
  pinMode(buttonB, INPUT);
  pinMode(buttonC, INPUT);
  pinMode(buttonD, INPUT);

  Serial.begin(9600);

  angle.attach(11);
}

bool switched = true;

void loop() {

  if(switched){
    angle.write(0);
    delay(1000);
    angle.write(45);
    delay(1000);
    angle.write(0);
    delay(1000);
    switched = false;
  }



  if(digitalRead(buttonA) == HIGH){
    Serial.println("Button A");
    while(digitalRead(buttonA) == HIGH){
      delay(100);
    }
  }

  if(digitalRead(buttonB) == HIGH){
    Serial.println("Button B");
    while(digitalRead(buttonB) == HIGH){
      delay(100);
    }
  }  

  if(digitalRead(buttonC) == HIGH){
    Serial.println("Button C");
    while(digitalRead(buttonC) == HIGH){
      delay(100);
    }
  }

  if(digitalRead(buttonD) == HIGH){
    Serial.println("Button D");
    while(digitalRead(buttonD) == HIGH){
      delay(100);
    }
  }
}