#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(10);
  myservo2.attach(11);
  myservo3.attach(12);
  myservo4.attach(13);
  myservo5.attach(9);

myservo1.write(50);
myservo2.write(70);
myservo3.write(70);
myservo4.write(100);
myservo5.write(100);
delay(300);
}
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;
}