#include <Servo.

h>
// membuat nama objek servo untuk pengontrolan servo
Servo servo1,servo2,servo3,servo4,servo5;
int i;
void setup()
{
servo1.attach(5);
servo2.attach(6);
servo3.attach(7);
servo4.attach(8);
servo5.attach(9); //mengatur pin servo
}
void Servo1kanan(int a,int b){
for(i=a;i<=b;i++){
servo1.write(i);
delay(35);
}
}
void Servo1kiri(int a,int b){
for(i=a;i>=b;i--){
servo1.write(i);
delay(35);
}
}
void Servo2turun(int a,int b){
for(i=a;i<=b;i++){
servo2.write(i);
delay(50);
}
}
void Servo2naik(int a,int b){
for(i=a;i>=b;i--){
servo2.write(i);
delay(50);
}
}

void Servo3_4naik(int srv,int a,int b){

for(i=a;i<=b;i++){
if(srv==3){
servo3.write(i);
delay(50);
}else if(srv==4){
servo4.write(i);
delay(20);
}
}
}
void Servo3_4turun(int srv,int a,int b){
for(i=a;i>=b;i--){
if(srv==3){
servo3.write(i);
delay(50);
}else if(srv==4){
servo4.write(i);
delay(20);
}
}
}
int srv;
void loop()
{
delay(1000);
servo2.write(90);
//Servo2naik(156,90);

delay(2000);
Servo1kiri(90,45);

delay(1000);
Servo2turun(90,156);
servo5.write(0);
srv=3;
Servo3_4naik(srv,90,110);
srv=4;
Servo3_4turun(srv,90,10);

delay(2000);
servo5.write(90);
//
delay(1000);
Servo2naik(156,90);

delay(2000);
Servo1kanan(45,135);

delay(1000);
Servo2turun(90,156);

delay(2000);
servo5.write(0);
srv=4;
Servo3_4naik(srv,10,90);
Servo2naik(156,90);
srv=3;
Servo3_4turun(srv,110,90);
delay(1000);
Servo1kiri(135,90);
// Servo2turun(90,156);
}