import machine
import time

trig_pin = machine.Pin(5, machine.Pin.OUT)
echo_pin = machine.Pin(4, machine.Pin.IN)

def read_distance():
    trig_pin.on()
    time.sleep_us(10)
    trig_pin.off()

    while echo_pin.value() == 0:
        pulse_start = time.ticks_us()

    while echo_pin.value() == 1:
        pulse_end = time.ticks_us()

    duration = pulse_end - pulse_start

    distance = (duration * 0.0343) / 2
    return distance

while True:
    distance = read_distance()
    print("Distància:", distance, "cm")
    time.sleep(1)