#include <Servo.h>
int pos = 0;
int pos1 = 0;
int servo_speed = 5;
int servo_speed1 = 5;
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;
Servo servo6;
Servo servo7;
void setup() {
servo1.attach(9);
servo2.attach(10);
servo3.attach(11);
servo4.attach(6);
servo5.attach(5);
servo6.attach(3);
servo7.attach(12);
}
void loop() {
step0();
delay(500);
step1();
delay(1000);
step2();
delay(1000);
step3();
delay(500);
step4();
delay(500);
step5();
delay(500);
step6();
delay(500);
step7();
delay(500);
step8();
delay(500);
step9();
delay(500);
step10();
delay(500);
step11();
delay(500);
step12();
delay(500);
step13();
delay(500);
step14();
delay(500);
}
void step0() {
for (pos = 0; pos <= 180; pos += 1) {
servo1.write(pos);
delay(servo_speed1);
servo2.write(pos);
delay(servo_speed1);
servo3.write(pos);
delay(servo_speed1);
servo4.write(pos);
delay(servo_speed1);
servo5.write(pos);
delay(servo_speed1);
servo6.write(90);
delay(servo_speed1);
servo7.write(pos);
delay(servo_speed1);
}
}
void step1() {
for (pos1 = 180; pos1 >= 0; pos1 -= 1) {
servo1.write(pos1);
delay(servo_speed1);
servo2.write(pos1);
delay(servo_speed1);
servo3.write(pos1);
delay(servo_speed1);
servo4.write(pos1);
delay(servo_speed1);
servo5.write(pos1);
delay(servo_speed1);
servo6.write(0);
delay(servo_speed1);
servo7.write(pos);
delay(servo_speed1);
}
}
void step2() {
servo1.write(0);
servo2.write(135);
servo3.write(90);
servo4.write(0);
servo5.write(90);
servo6.write(180);
servo7.write(0);
}
void step3() {
servo1.write(0);
servo2.write(90);
servo3.write(45);
servo4.write(45);
servo5.write(90);
servo6.write(170);
servo7.write(90);
}
void step4() {
servo1.write(0);
servo2.write(135);
servo3.write(90);
servo4.write(45);
servo5.write(30);
servo6.write(90);
servo7.write(0);
}
void step5() {
servo1.write(90);
servo2.write(135);
servo3.write(90);
servo4.write(45);
servo5.write(30);
servo6.write(90);
servo7.write(90);
}
void step6() {
servo1.write(90);
servo2.write(90);
servo3.write(135);
servo4.write(30);
servo5.write(50);
servo6.write(45);
servo7.write(0);
}
void step7() {
servo1.write(90);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(135);
servo6.write(170);
servo7.write(90);
}
void step8() {
servo1.write(90);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(170);
servo6.write(170);
servo7.write(0);
}
void step9() {
servo1.write(90);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(135);
servo6.write(170);
servo7.write(90);
}
void step10() {
servo1.write(90);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(170);
servo6.write(170);
servo7.write(0);
}
void step11() {
servo1.write(90);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(135);
servo6.write(170);
servo7.write(90);
}
void step12() {
servo1.write(0);
servo2.write(135);
servo3.write(180);
servo4.write(135);
servo5.write(90);
servo6.write(90);
servo7.write(0);
}
void step13() {
servo1.write(0);
servo2.write(90);
servo3.write(45);
servo4.write(45);
servo5.write(90);
servo6.write(90);
servo7.write(90);
}
void step14() {
servo1.write(0);
servo2.write(0);
servo3.write(0);
servo4.write(0);
servo5.write(0);
servo6.write(0);
servo7.write(0);
}