#include <Servo.h>

int button1 = 11;
int button2 = 10;
int button3 = 6;
int button4 = 7;
int LED1 = 8;
int LED2 = 9;
Servo servoL;
Servo servoR;
int degree = 90;
bool state1 = false;
bool state2 = false;
void setup() {
  Serial.begin(115200);
  pinMode(button1, INPUT_PULLUP);
  pinMode(button2, INPUT_PULLUP);
  pinMode(button3, INPUT_PULLUP);
  pinMode(button4, INPUT_PULLUP);
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
  servoL.attach(13);
  servoR.attach(12);
}

int i = 0;

void loop() {
  if (digitalRead(button1) == 0 && degree > 0) {
    degree -= 2;
  }

  if (digitalRead(button2) == 0 && degree < 180) {
    degree += 2;
  }
  servoL.write(degree);
  servoR.write(degree);
  Serial.println(degree);
  if (digitalRead(button3) == 0) {
    if (state2) {
      state2 = false;
    } else {
      state1 = true;
    }
  }
  if (digitalRead(button4) == 0) {
    if (state1) {
      state1 = false;
    } else {
      state2 = true;
    }
  }
  digitalWrite(LED1, state1);
  digitalWrite(LED2, state2);
  delay(100);
}