#include <ESP32Servo.h>
int p1 = 34;
int p2 = 35;

int s1 = 16;
int s2 = 2;
int s3 = 4;
int s4 = 12;
int s5 = 13;
int s6 = 19;
int s7 = 17;
int s8 = 5;
int s9 = 18;
int s10 = 14;
int s11 = 27;
int s12 = 26;
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
Servo servo5;
Servo servo6;
Servo servo7;
Servo servo8;
Servo servo9;
Servo servo10;
Servo servo11;
Servo servo12;

void setup() {
pinMode(p1, INPUT_PULLUP);
pinMode(p2, INPUT_PULLUP);


  pinMode(s1, OUTPUT);
  pinMode(s2, OUTPUT);
  pinMode(s3, OUTPUT);

  servo1.attach(s1);
  servo2.attach(s2);
  servo3.attach(s3);

 pinMode(s4, OUTPUT);
  pinMode(s5, OUTPUT);
  pinMode(s6, OUTPUT);

  servo4.attach(s4);
  servo5.attach(s5);
  servo6.attach(s6);
  
  pinMode(s7, OUTPUT);
  pinMode(s8, OUTPUT);
  pinMode(s9, OUTPUT);

  servo7.attach(s7);
  servo8.attach(s8);
  servo9.attach(s9);

  pinMode(s10, OUTPUT);
  pinMode(s11, OUTPUT);
  pinMode(s12, OUTPUT);

    servo10.attach(s10);
  servo11.attach(s11);
  servo12.attach(s12);
}

void loop() {
int p1s=digitalRead(p1);
int p2s=digitalRead(p2);
Serial.print(p1s);
Serial.print(p1s);


if(p1s==1 && p2s==0){
front();
}
else if(p1s==0 && p2s==1){
back();
}
}


void center(){
const int o=90;

servo1.write(o);
servo2.write(o);
servo3.write(o);

servo4.write(o);
servo5.write(o);
servo6.write(o);

servo7.write(o);
servo8.write(o);
servo9.write(o);

servo10.write(o);
servo11.write(o);
servo12.write(o);
    delay(1000);
}


void front(){
  const int t=120;
  const int o=90;

servo1.write(t);
servo2.write(t);
servo3.write(t);
    delay(1000);
servo1.write(o);
servo2.write(o);
servo3.write(o);

servo4.write(t);
servo5.write(t);
servo6.write(t);
    delay(1000);
servo4.write(o);
servo5.write(o);
servo6.write(o);

servo7.write(t);
servo8.write(t);
servo9.write(t);
    delay(1000);
servo7.write(o);
servo8.write(o);
servo9.write(o);

servo10.write(t);
servo11.write(t);
servo12.write(t);
    delay(1000);
servo10.write(o);
servo11.write(o);
servo12.write(o);
}


void back(){
  const int s=60;
  const int o=90;


servo1.write(s);
servo2.write(s);
servo3.write(s);
    delay(1000);
servo1.write(o);
servo2.write(o);
servo3.write(o);

servo4.write(s);
servo5.write(s);
servo6.write(s);
    delay(1000);
servo4.write(o);
servo5.write(o);
servo6.write(o);

servo7.write(s);
servo8.write(s);
servo9.write(s);
    delay(1000);
servo7.write(o);
servo8.write(o);
servo9.write(o);

servo10.write(s);
servo11.write(s);
servo12.write(s);
    delay(1000);
servo10.write(o);
servo11.write(o);
servo12.write(o);


}