#include <Servo.h>

Servo myservo1;
Servo myservo2;

int ledGreen1 = 9;
int ledRed1 = 10;

int ledGreen2 = 11;
int ledRed2 = 12;

int pos1 = -90;
int pos2 = -90;


void setup() {
  // put your setup code here, to run once:
  myservo1.attach(5);
  myservo2.attach(6);

  pinMode(ledGreen1, OUTPUT);
  pinMode(ledRed1, OUTPUT);
  pinMode(ledGreen2, OUTPUT);
  pinMode(ledRed2, OUTPUT);

  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, LOW);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, LOW);

  Serial.begin(9600);
  delay(700);

  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, HIGH);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, HIGH);
  Serial.write("Ready!");
  delay(1300);

}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, HIGH);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, HIGH);

  digitalWrite(ledGreen1, HIGH);
  digitalWrite(ledRed1, LOW);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, HIGH);
  myservo1.write(0);
  delay(170);
  myservo1.write(90);
  
  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, HIGH);
  digitalWrite(ledGreen2, HIGH);
  digitalWrite(ledRed2, LOW);
  myservo2.write(0);
  delay(170);
  myservo2.write(90);

  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, HIGH);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, HIGH);


  delay(2700);


  digitalWrite(ledGreen1, HIGH);
  digitalWrite(ledRed1, LOW);
  digitalWrite(ledGreen2, LOW);
  digitalWrite(ledRed2, HIGH);
  myservo1.write(0);
  delay(170);
  myservo1.write(-90);

  digitalWrite(ledGreen1, LOW);
  digitalWrite(ledRed1, HIGH);
  digitalWrite(ledGreen2, HIGH);
  digitalWrite(ledRed2, LOW);
  myservo2.write(0);
  delay(170);
  myservo2.write(-90);

  delay(1900);

  
}