#include <Servo.h>

Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;

int pos1 = 120;
int pos2 = 60;
int pos3 = 60;
int pos4 = 60;
int pos5 = 60;

//1: 30-120 = 90
//2: 60-150 = 90
//3: 60-150 = 90
//4: 60-150 = 90
//5: 60-150 = 90

void setup() {
  servo1.attach(3);
  servo2.attach(5);
  servo3.attach(6);
  servo4.attach(9);
  servo5.attach(10);
  servo1.write(pos1);
  servo2.write(pos2);
  servo3.write(pos3);
  servo4.write(pos4);
  servo5.write(pos5);
  delay(500);
}

void loop() {
  finger1();
  delay(500);
  finger2();
  delay(500);
  finger3();
  delay(500);
  finger4();
  delay(500);
  finger5();
  delay(500);
}

void finger1() {
  for (pos1 = 120; pos1 >= 30; pos1 -= 1) {
    servo1.write(pos1);
    delay(15);
  }
  for (pos1 = 30; pos1 <= 120; pos1 += 1) {
    servo1.write(pos1);
    delay(15);
  }
}

void finger2() {
  for (pos2 = 60; pos2 <= 150; pos2 += 1) {
    servo2.write(pos2);
    delay(15);
  }
  for (pos2 = 150; pos2 >= 60; pos2 -= 1) {
    servo2.write(pos2);
    delay(15);
  }
}

void finger3() {
  for (pos3 = 60; pos3 <= 150; pos3 += 1) {
    servo3.write(pos3);
    delay(15);
  }
  for (pos3 = 150; pos3 >= 60; pos3 -= 1) {
    servo3.write(pos3);
    delay(15);
  }
}

void finger4() {
  for (pos4 = 60; pos4 <= 150; pos4 += 1) {
    servo4.write(pos4);
    delay(15);
  }
  for (pos4 = 150; pos4 >= 60; pos4 -= 1) {
    servo4.write(pos4);
    delay(15);
  }
}

void finger5() {
  for (pos5 = 60; pos5 <= 150; pos5 += 1) {
    servo5.write(pos5);
    delay(15);
  }
  for (pos5 = 150; pos5 >= 60; pos5 -= 1) {
    servo5.write(pos5);
    delay(15);
  }
}