#include <ESP32Servo.h>
int servoPin1 = 25; //kaki kiri depan
int servoPin2 = 26; //lengan kiri depan
int servoPin3 = 13; //lengan kiri belakang
int servoPin4 = 12; //kaki kiri belakang

int servoPin5 = 16; //kaki kanan depan
int servoPin6 = 18; //lengan kanan depan
int servoPin7 = 4;  //lengan kanan belakang
int servoPin8 = 2;  //kaki kanan belakang

Servo Servo1;
Servo Servo2;
Servo Servo3;
Servo Servo4;
Servo Servo5;
Servo Servo6;
Servo Servo7;
Servo Servo8;


void setup() {
      Servo1.attach(servoPin1);
      Servo2.attach(servoPin2);
      Servo3.attach(servoPin3);
      Servo4.attach(servoPin4);

      Servo5.attach(servoPin5);
      Servo6.attach(servoPin6);
      Servo7.attach(servoPin7);
      Servo8.attach(servoPin8);
}


void loop() {
  //Posisi Awal Untuk kalibrasi
   Servo1.write(90);
   Servo2.write(90);
   Servo3.write(90);
   Servo4.write(90);
   Servo5.write(90);
   Servo6.write(90);
   Servo7.write(90);
   Servo8.write(90);
   delay(2000);

   //Posisi standby
   Servo1.write(90);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(90);
   Servo5.write(90);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(90);
   delay(1000);
   Servo1.write(75);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(75);
   delay(2000);

   //turnaik
   Servo1.write(85);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(95);
   Servo5.write(95);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(85);
   delay(1000);
   Servo1.write(75);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(75);
   delay(2000);
   Servo1.write(85);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(95);
   Servo5.write(95);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(85);
   delay(1000);
   Servo1.write(75);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(75);
   delay(1000);
   Servo1.write(75);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(75);
   delay(2000);
   //Kanan-kiri
   Servo1.write(75);
   Servo2.write(90);
   Servo3.write(90);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(90);
   Servo7.write(90);
   Servo8.write(75);
   delay(1000);
   Servo1.write(105);
   Servo2.write(90);
   Servo3.write(90);
   Servo4.write(90);
   Servo5.write(90);
   Servo6.write(90);
   Servo7.write(90);
   Servo8.write(105);
   delay(1000);
   Servo1.write(75);\
   Servo2.write(90);
   Servo3.write(90);
   Servo4.write(105);
   Servo5.write(105);
   Servo6.write(90);
   Servo7.write(90);
   Servo8.write(75);
   delay(1000);
   Servo1.write(105);
   Servo2.write(90);
   Servo3.write(90);
   Servo4.write(90);
   Servo5.write(90);
   Servo6.write(90);
   Servo7.write(90);
   Servo8.write(105);
   delay(1000);
  //Kembali ke posisi standby
   Servo1.write(90);
   Servo2.write(105);
   Servo3.write(75);
   Servo4.write(90);
   Servo5.write(90);
   Servo6.write(75);
   Servo7.write(105);
   Servo8.write(90);
   delay(1000);
   Servo1.write(75);  //kaki kiri depan
   Servo2.write(105); //lengan kiri depan
   Servo3.write(75);  //lengan kiri belakang
   Servo4.write(105); //kaki kiri belakang
   Servo5.write(105);  //kaki kanan depan
   Servo6.write(75);  //lengan kanan depan
   Servo7.write(105); //lengan kanan belakang
   Servo8.write(75);  //kaki kanan belakang
   delay(2000);
}