//------------------------< Library : Servo >
#include <Servo.h>
//------------------------< define values : Servo >
Servo servoA;
Servo servoB;
Servo servoC;
Servo servoD;
Servo servoE;
//--------------------------< define values : Led Switch >
#define ledS 11
void setup() {
Serial.begin(9600);
pinMode(4, INPUT_PULLUP);
pinMode(ledS, OUTPUT);
servoA.attach(3);
servoB.attach(5);
servoC.attach(6);
servoD.attach(9);
servoE.attach(10);
servoA.write(0);
servoB.write(0);
servoC.write(0);
servoD.write(0);
servoE.write(0);
digitalWrite(ledS, LOW);
}
void loop() {
int button = digitalRead(4);
Serial.println(button);
if(button == 0){
digitalWrite(ledS, HIGH);
Fucn_Step1();
Fucn_Step2();
Fucn_Step1();
Fucn_Step3();
Fucn_Step4();
digitalWrite(ledS, LOW);
}
}
//--------------------< plaet-A : >
void Fucn_Step1(){
servoA.write(110);
delay(1000);
servoA.write(0);
delay(1000);
}
//--------------------< plaet-C : >
void Fucn_Step2(){
servoC.write(110);
delay(1000);
servoC.write(0);
delay(1000);
}
//--------------------< plaet-B : >
void Fucn_Step3(){
servoB.write(110);
delay(1000);
servoB.write(0);
delay(1000);
}
//--------------------< plaet-D,plaet-E : >
void Fucn_Step4(){
servoD.write(90);
servoE.write(90);
delay(1000);
servoD.write(0);
servoE.write(0);
delay(1000);
}