from machine import Pin
from time import sleep, sleep_us, ticks_us

class HCSR04:
    def __init__ (self, trigger, echo):
        self.trigger=Pin(trigger,Pin.OUT, Pin.PULL_DOWN)
        self.echo=Pin(echo, Pin.IN, Pin.PULL_DOWN)

    def medir_distancia(self):
        self.trigger.off()
        sleep_us(5)
        self.trigger.on()
        sleep_us(10)
        self.trigger.off()

        while self.echo.value()==0:
            tiempo_inicial = ticks_us()
        while self.echo.value()==1:
            tiempo_final = ticks_us()

        tiempo_delta = (tiempo_final-tiempo_inicial)
        distancia = ((tiempo_delta * 0.0343) / 2)

        return distancia

sensor = HCSR04(23,22)

while True:
    dato = sensor.medir_distancia()
    print("Distancia",round(dato,2),"cm")
    sleep(0.5)