from Libreria import HCSR04
from time import sleep
from machine import Pin

medidor=HCSR04(trigger_pin=4,echo_pin=5)
led1=Pin(13,Pin.OUT)
led2=Pin(12,Pin.OUT)
led3=Pin(14,Pin.OUT)
led4=Pin(27,Pin.OUT)

while True:
    try:
        distancia=medidor.distance_cm()
        print("Distancia:",distancia)
        if distancia>50 and distancia<=100:
            led1.on()
            led2.off()
            led3.off()
            led4.off()
        elif distancia>100 and distancia<=200:
            led1.off()
            led2.on()
            led3.off()
            led4.off()
        elif distancia>200 and distancia<=400:
            led1.off()
            led2.off()
            led3.on()
            led4.off()
        elif distancia>400:
            led1.off()
            led2.off()
            led3.off()
            led4.on()
        else:
            led1.off()
            led2.off()
            led3.off()
            led4.off()
    except:
        print("Error")
    
    sleep(0.1)