#include <Adafruit_TinyUSB.h>

// Pines del HC-SR04
const int TRIG = D9;
const int ECHO = D10;

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  pinMode(MY_LED, OUTPUT);
  digitalWrite(MY_LED, LOW);
  digitalWrite(TRIG, LOW);

  Serial.begin(9600);
  delay(1000);
}

long medirDistancia() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  long duracion = pulseIn(ECHO, HIGH, 30000);
  long distancia = duracion * 0.0343 / 2;

  return distancia;
}

void loop() {
  long distancia = medirDistancia();

  if (distancia <= 0 || distancia > 400) {
    Serial.println("⚠️  Fuera de rango o sin objeto detectado.");
    digitalWrite(MY_LED, LOW);
  } else if (distancia < 20) {
    Serial.print("🔴 ¡Objeto MUY CERCA! Distancia: ");
    Serial.print(distancia);
    Serial.println(" cm");
    digitalWrite(MY_LED, HIGH);
  } else {
    Serial.print("🟢 Objeto detectado. Distancia: ");
    Serial.print(distancia);
    Serial.println(" cm");
    digitalWrite(MY_LED, LOW);
  }

  delay(2000);
}