from machine import Pin, time_pulse_us
import time

trig = Pin(5, Pin.OUT)
echo = Pin(18, Pin.IN)
led_rojo = Pin(21, Pin.OUT)
led_verde = Pin(22, Pin.OUT)

def medir_distancia():

    trig.off()
    time.sleep_us(2)
    trig.on()
    time.sleep_us(10)
    trig.off()

   
    duracion = time_pulse_us(echo, 1, 30000)
    distancia_cm = (duracion / 2) / 29.1  

    return distancia_cm

while True:
    distancia_cm = medir_distancia()
    distancia_m = distancia_cm / 100
    distancia_km = distancia_cm / 100000

    print("Distancia: {:.2f} cm, {:.4f} m, {:.6f} km".format(distancia_cm, distancia_m, distancia_km))

    if distancia_cm > 200:
        led_rojo.on()
        led_verde.off()
    else:
        led_rojo.off()
        led_verde.on()

    time.sleep(1)