const int trig = 9, echo = 10;
const int ledVerde = 2;
const int ledAmarillo = 3;
const int ledRojo = 4;

void setup() {
  Serial.begin(9600);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  
  // Configurar los pines de los LEDs como salida
  pinMode(ledVerde, OUTPUT);
  pinMode(ledAmarillo, OUTPUT);
  pinMode(ledRojo, OUTPUT);
}

void loop() {
  // Lógica del sensor ultrasónico
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  
  long t = pulseIn(echo, HIGH);
  int d = t * 0.034 / 2; // d es la distancia en cm
  
  Serial.println(d);

  // Apagamos todos los LEDs primero
  digitalWrite(ledVerde, LOW);
  digitalWrite(ledAmarillo, LOW);
  digitalWrite(ledRojo, LOW);

  // Lógica de encendido según la distancia
  if (d >= 100) {
    digitalWrite(ledVerde, HIGH);
  } else if (d > 50 && d < 100) {
    digitalWrite(ledAmarillo, HIGH);
  } else if (d <= 50) {
    digitalWrite(ledRojo, HIGH);
  }

  delay(200);
}