#include <Servo.h>
Servo myservo1;
Servo myservo2;
Servo myservo3;
Servo myservo4;
int val1;
int val2;
int val3;
int val4;
void setup() {
// put your setup code here, to run once:
pinMode(3, OUTPUT); //red diode 1
pinMode(5, OUTPUT); //red diode 2
pinMode(9, OUTPUT); //red diode 3
pinMode(8, OUTPUT); //red diode 4
pinMode(10, OUTPUT); //green diode 1
pinMode(11, OUTPUT); //green diode 2
pinMode(13, OUTPUT); //green diode 3
pinMode(12, OUTPUT); //green diode 4
myservo1.attach(2); //servo 1
myservo2.attach(4); //servo 2
myservo3.attach(7); //servo 3
myservo4.attach(6); //servo 4
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(3, LOW); //RD 1
digitalWrite(5, HIGH); //RD 2
digitalWrite(9, LOW); //RD 3
digitalWrite(8, HIGH); //RD 4
delay(500); // timing for gate going right (j)
digitalWrite(10, HIGH); //GD 1
digitalWrite(11, LOW); //GD 2
digitalWrite(13, HIGH); //GD 3
digitalWrite(12, LOW); //GD 4
delay(1000); //timing of gates changing for right (x)
val1 = map(0, 1023, 0, 0, 90);
val2 = map(0, 1023, 0, 0, 90);
val3 = map(0, 1023, 0, 0, 90);
val4 = map(0, 1023, 0, 0, 90);
myservo1.write(val1);
myservo2.write(val2);
myservo3.write(val3);
myservo4.write(val4);
delay(5000); //timing for going right
digitalWrite(3, HIGH); // RD 1
digitalWrite(5, LOW); // RD 2
digitalWrite(9, HIGH); // RD 3
digitalWrite(8, LOW); // RD 4
digitalWrite(10, LOW); // GD 1
digitalWrite(11, HIGH); // GD 2
digitalWrite(13, LOW); // GD 3
digitalWrite(12, HIGH); // GD 4
delay(500); //timing for gate going up (j)
val1 = map(0, 1023, 0, 180, 0);
val2 = map(0, 1023, 0, 180, 0);
val3 = map(0, 1023, 0, 0, 180);
val4 = map(0, 1023, 0, 0, 180);
myservo1.write(val1);
myservo2.write(val2);
myservo3.write(val3);
myservo4.write(val4);
delay(5000); // timing of going up (x)
}