#include <ESP32Servo.h>

const int servoPin1 = 17;
const int servoPin2 = 18;
const int servoPin3 = 19;
const int servoPin4 = 5;

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

void setup() {
  servo1.attach(servoPin1, 500, 2400);
  servo2.attach(servoPin2, 500, 2400);
  servo3.attach(servoPin3, 500, 2400);
  servo4.attach(servoPin4, 500, 2400);
}

void loop() {
  // Quay servo 1 và 2 từ 0 đến 180 độ
  for (int pos = 0; pos <= 180; pos += 1) {
    servo1.write(pos);
    servo2.write(pos);
    delay(15);
  }
  // Quay servo 1 và 2 từ 180 về 0 độ
  for (int pos = 180; pos >= 0; pos -= 1) {
    servo1.write(pos);
    servo2.write(pos);
    delay(15);
  }

  // Quay servo 3 và 4 ngược chiều nhau từ 0 đến 180 độ
  for (int pos = 0; pos <= 180; pos += 1) {
    servo3.write(pos);
    servo4.write(180 - pos);
    delay(15);
  }
  // Quay servo 3 và 4 ngược chiều nhau từ 180 về 0 độ
  for (int pos = 180; pos >= 0; pos -= 1) {
    servo3.write(180 - pos);
    servo4.write(pos);
    delay(15);
  }
}