from machine import Pin,time_pulse_us
import utime

# Ultrasone sensor pinnen
TRIG_PIN = 4
ECHO_PIN = 5

# Ultrasone sensor setup
trig = Pin(TRIG_PIN, Pin.OUT)
echo = Pin(ECHO_PIN, Pin.IN)

def measure_distance():
    """ Meet de afstand met de ultrasone sensor """
    trig.off()
    utime.sleep_us(2)
    trig.on()
    utime.sleep_us(10)
    trig.off()

    try:
        duration = time_pulse_us(echo, 1, 30000)  # Max 30ms voor een timeout
    except OSError:
        return None

    if duration <= 0:
        return None

    distance = (duration / 2) / 29.1  # Converteer naar centimeters
    return distance

def main():

    while True:
        
        print('%d'%(measure_distance()))
        time.sleep(1)

if __name__ == "__main__":
    main()