#include<ESP32Servo>
#include <UltrasonicSensor>

Servo servo1;
Servo servo2;
Ultrasonic ultrasonic(D14, D4); // Pin Trig dan Echo

void setup() {
  servo1.attach(D12); // Hubungkan servo1 ke pin D12
  servo2.attach(D2); // Hubungkan servo2 ke pin D2
}

void loop() {
  int distance = ultrasonic.read();
  if (distance < 20) { // Jarak deteksi kendaraan dalam cm
    openGate(); // Buka gerbang
  } else {
    closeGate(); // Tutup gerbang
  }
}

void openGate() {
  servo1.write(0); // Putar servo1 ke posisi buka gerbang
  servo2.write(180); // Putar servo2 ke posisi buka gerbang
  delay(2000); // Tahan gerbang terbuka selama 2 detik
}

void closeGate() {
  servo1.write(90); // Putar servo1 ke posisi tutup gerbang
  servo2.write(90); // Putar servo2 ke posisi tutup gerbang
}