#include <Servo.h>
Servo myservo1;
Servo myservo2;
int z1 = 10;
int r1 = 9;
int z2 = 12;
int r2 = 13;
int pos1 = 0;
int pos2 = 0;
void setup() {
// put your setup code here, to run once:
myservo1.attach(5);
myservo2.attach(6);
pinMode(z1, OUTPUT);
pinMode(r1, OUTPUT);
pinMode(z2, OUTPUT);
pinMode(r2, OUTPUT);
myservo1.write(0);
myservo2.write(0);
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(z1, LOW);
digitalWrite(r1, LOW);
digitalWrite(z2, LOW);
digitalWrite(r2, LOW);
digitalWrite(z1, LOW);
digitalWrite(r1, HIGH);
digitalWrite(z2, LOW);
digitalWrite(r2, HIGH);
digitalWrite(z1, HIGH);
digitalWrite(r1, LOW);
digitalWrite(z2, LOW);
digitalWrite(r2, HIGH);
for (pos1 = 0; pos1 <= 180; pos1 ++) {
myservo1.write(pos1);
delay(15);
}
digitalWrite(z1, LOW);
digitalWrite(r1, HIGH);
digitalWrite(z2, HIGH);
digitalWrite(r2, LOW);
for (pos2 = 0; pos2 <= 180; pos2 ++) {
myservo2.write(pos2);
delay(15);
}
digitalWrite(z1, LOW);
digitalWrite(r1, HIGH);
digitalWrite(z2, LOW);
digitalWrite(r2, HIGH);
delay(3700);
digitalWrite(z1, HIGH);
digitalWrite(r1, LOW);
digitalWrite(z2, LOW);
digitalWrite(r2, HIGH);
for (pos1 = 180; pos1 >= 0; pos1--) {
myservo1.write(pos1);
delay(15);
}
digitalWrite(z1, LOW);
digitalWrite(r1, HIGH);
digitalWrite(z2, HIGH);
digitalWrite(r2, LOW);
for (pos2 = 180; pos2 >= 0; pos2--) {
myservo2.write(pos2);
delay(15);
}
digitalWrite(z1, LOW);
digitalWrite(r1, HIGH);
digitalWrite(z2, LOW);
digitalWrite(r2, HIGH);
}