#include <ESP32Servo.h>

const int ledPin = 13;         // Broche de la LED rouge
const int servoPin = 5;        // Broche de contrôle du servo
const int trigPin = 7;         // Broche de déclenchement du capteur ultrasonique
const int echoPin = 6;         // Broche de réception du capteur ultrasonique
const int distanceThreshold = 50; // Seuil de distance pour déclencher la barrière (en cm)

Servo myServo;

void setup() {
  pinMode(ledPin, OUTPUT);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  myServo.attach(servoPin);
}

void loop() {
  long duration, distance;
  
  // Envoie une impulsion ultrasonique
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  // Lit la durée de l'impulsion ultrasonique
  duration = pulseIn(echoPin, HIGH);
  
  // Calcule la distance en centimètres
  distance = duration * 0.034 / 2;

  if (distance <= distanceThreshold) {
    // Si la distance est inférieure ou égale au seuil, lever la barrière et allumer la LED rouge
    myServo.write(35);
    digitalWrite(ledPin, HIGH);
    delay(1000);  // Laisser le temps à la barrière de se lever
  } else {
    // Sinon, baisser la barrière et éteindre la LED rouge
    myServo.write(0);
    digitalWrite(ledPin, LOW);
  }
}