#include <ESP32Servo.h>
//#include <analogWrite.h>
//#include <tone.h>
//#include <ESP32Tone.h>
//#include <ESP32PWM.h>

Servo servo_1;
Servo servo_2;
Servo servo_3;
Servo servo_4;
Servo servo_5;
Servo servo_6;
int pos_1 = 0;
int pos_2 = 0;
int pos_3 = 0;

#define servo_1Pin 25
#define servo_2Pin 26
#define servo_3Pin 27
#define servo_4Pin 2
#define servo_5Pin 4
#define servo_6Pin 5

void setup() {
  servo_1.attach(servo_1Pin);
  servo_1.write(0);
  servo_2.attach(servo_2Pin);
  servo_2.write(0);
  servo_3.attach(servo_3Pin);
  servo_3.write(180);
  servo_4.attach(servo_4Pin);
  servo_4.write(180);
  servo_5.attach(servo_5Pin);
  servo_5.write(90);
  servo_6.attach(servo_6Pin);
  servo_6.write(90);
}

void loop (){

  for (pos_1 = 0; pos_1 <=180; pos_1 += 1){
    servo_1.write(pos_1);
    servo_2.write(pos_1);
    delay(15);
  }

  for (pos_1 = 180; pos_1 >=0; pos_1 -= 1){
    servo_1.write(pos_1);
    servo_2.write(pos_1);
    delay(15);
  }

  for (pos_2 = 180; pos_2 >=0; pos_2 -= 1){
    servo_3.write(pos_2);
    servo_4.write(pos_2);
    delay(15);
  }

  for (pos_2 = 0; pos_2 <=180; pos_2 += 1){
    servo_3.write(pos_2);
    servo_4.write(pos_2);
    delay(15);
  }
  
  for (pos_3 = 90; pos_3 >=0; pos_3 -= 1){
    servo_5.write(pos_3);
    servo_6.write(pos_3);
    delay(15);
  }

  for (pos_3 = 0; pos_3 <=180; pos_3 += 1){
    servo_5.write(pos_3);
    servo_6.write(pos_3);
    delay(15);
  }

}