import machine
import time

# Define els pins del sensor d'ultrasons
trig_pin = machine.Pin(18, machine.Pin.OUT)
echo_pin = machine.Pin(5, machine.Pin.IN)

# Funció per enviar un senyal al sensor d'ultrasons i rebre una resposta
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
    
	# La distància es calcula a partir de la durada de l'eco
	distance = (duration * 0.0343) / 2  
	# 0.0343 cm/us és la velocitat del so

	return distance

# Llegeix la distància del sensor
while True:
	distance = read_distance()
	print("Distància:", distance, "cm")
	time.sleep(1)