#include<Servo.h>
Servo myservo1;
Servo myservo2;
Servo myservo3;
Servo myservo4;
Servo myservo5;
int a;
int b;
int c;
int d;
int e;
void setup(){
myservo1.attach(8);
myservo2.attach(9);
myservo3.attach(10);
myservo4.attach(11);
myservo5.attach(7);
myservo1.write(50);
myservo2.write(70);
myservo3.write(70);
myservo4.write(100);
myservo5.write(100);
delay(3000);
}
void loop(){
kanan();
mundur();
turun();
up();
japit();
naik();
down();
maju();
kiri();
mundur();
turun();
up();
lepas();
naik();
down();
maju();
//japit();
//lepas();
}
void kanan(){
for(a=50;a<=150;a++){
myservo1.write(a);
delay(50);
}
return;
}
void kiri(){
for(a=150;a>=50;a--){
myservo1.write(a);
delay(50);
}
return;
}
void maju(){
for(b=100;b>=70;b--){
myservo2.write(b);
delay(50);
}
return;
}
void mundur(){
for(b=70;b<=100;b++){
myservo2.write(b);
delay(50);
}
return;
}
void turun(){
for(c=70;c<=100;c++){
myservo3.write(c);
delay(50);
}
return;
}
void naik(){
for(c=100;c>=70;c--){
myservo3.write(c);
delay(50);
}
return;
}
void up(){
for(d=100;d>=10;d--){
myservo4.write(d);
delay(50);
}
return;
}
void down(){
for(d=10;d<=100;d++){
myservo4.write(d);
delay(50);
}
return;
}
void japit(){
for(e=100;e>=40;e--){
myservo5.write(e);
delay(50);
}
return;
}
void lepas(){
for(e=40;e<=100;e++){
myservo5.write(e);
delay(50);
}
return;
}