#include <Arduino.h>

// Definición de pines
const int trigPin = 5;
const int echoPin = 18;
const int redLED = 16;
const int yellowLED = 14;
const int greenLED = 13;

void setup() {
  // Configuración de pines
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(redLED, OUTPUT);
  pinMode(yellowLED, OUTPUT);
  pinMode(greenLED, OUTPUT);
  
  Serial.begin(115200);
}

void loop() {
  // Enviar pulso Trig
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  // Medir duración del pulso Echo
  long duration = pulseIn(echoPin, HIGH);
  
  // Calcular distancia
  float distance = (duration * 0.0343) / 2;
  Serial.println(distance);

  // Control de semáforo basado en distancia
  if (distance < 10) {
    // Si hay un vehículo cerca, el semáforo se pone en rojo
    digitalWrite(redLED, HIGH);
    digitalWrite(yellowLED, LOW);
    digitalWrite(greenLED, LOW);
  } else if (distance >= 10 && distance < 20) {
    // Si hay un vehículo a una distancia media, el semáforo se pone en amarillo
    digitalWrite(redLED, LOW);
    digitalWrite(yellowLED, HIGH);
    digitalWrite(greenLED, LOW);
  } else {
    // Si no hay vehículos cerca, el semáforo se pone en verde
    digitalWrite(redLED, LOW);
    digitalWrite(yellowLED, LOW);
    digitalWrite(greenLED, HIGH);
  }
  
  delay(1000); // Esperar 1 segundo antes de la siguiente medición
}