#include <Servo.h>
int first=3 , second=5 , third=6 ,forth =9 ,fifth =10;
int step_delay =50 ;
int change_delay =500;
int angle =0;
int count=0;
int move_No=1;
Servo first_finger ;
Servo second_finger ;
Servo third_finger ;
Servo forth_finger ;
Servo fifth_finger ;
void setup() {
pinMode (first ,OUTPUT);
pinMode (second ,OUTPUT);
pinMode (third ,OUTPUT);
pinMode (forth ,OUTPUT);
pinMode (fifth ,OUTPUT);
first_finger.attach (first);
second_finger.attach (second);
third_finger.attach (third);
forth_finger.attach (forth);
fifth_finger.attach (fifth);
Serial.begin (9600);
}
void loop() {
if (move_No ==1)
{
if (angle<90 && count==0 ){angle++;}
if (angle>=90){count=1; delay(change_delay);}
if (angle<=90 && count==1) {angle--;}
if (angle==0) {count=0; delay(change_delay); move_No=2;}
first_finger.write(angle );
delay(step_delay );
}
if (move_No ==2)
{
if (angle<90 && count==0 ){angle++;}
if (angle>=90){count=1; delay(change_delay);}
if (angle<=90 && count==1) {angle--;}
if (angle==0) {count=0; delay(change_delay); move_No=3;}
second_finger.write(angle );
delay(step_delay );
}
if (move_No ==3)
{
if (angle<90 && count==0 ){angle++;}
if (angle>=90){count=1; delay(change_delay);}
if (angle<=90 && count==1) {angle--;}
if (angle==0) {count=0; delay(change_delay); move_No=4;}
third_finger.write(angle );
delay(step_delay );
}
if (move_No ==4)
{
if (angle<90 && count==0 ){angle++;}
if (angle>=90){count=1; delay(change_delay);}
if (angle<=90 && count==1) {angle--;}
if (angle==0) {count=0; delay(change_delay); move_No=5;}
forth_finger.write(angle );
delay(step_delay );
}
if (move_No ==5)
{
if (angle<90 && count==0 ){angle++;}
if (angle>=90){count=1; delay(change_delay);}
if (angle<=90 && count==1) {angle--;}
if (angle==0) {count=0; delay(change_delay); move_No=1;}
fifth_finger.write(angle );
delay(step_delay );
}
Serial.println(angle);
}