#include <Servo.h>
#define horizontal_pin 3
#define vertical_pin 6
#define claw_pin 5
Servo horizontal, vertical;
Servo claw;
void setup() {
horizontal.attach(horizontal_pin);
vertical.attach(vertical_pin);
claw.attach(claw_pin);
horizontal.write(0);
vertical.write(0);
claw.write(0);
}
void loop() {
int degree = 0;
for(int i=0; i<6; ++i){
horizontal.write(0);
delay(500);
vertical.write(90);
delay(500);
claw.write(90);
delay(500);
vertical.write(0);
delay(500);
horizontal.write(30+degree);
delay(500);
vertical.write(90);
delay(500);
claw.write(0);
delay(500);
vertical.write(0);
delay(500);
degree += 30;
}
}