rom machine import Pin, time_pulse_us
import time


trigger_pin = 5  
echo_pin = 4     

trigger = Pin(trigger_pin, Pin.OUT)
echo = Pin(echo_pin, Pin.IN)


def measure_distance():
    # Send a 10 microsecond pulse to trigger the sensor
    trigger.value(1)
    time.sleep_us(10)
    trigger.value(0)

    # Measure the duration of the pulse on the echo pin
    duration = time_pulse_us(echo, 1, 30000)  # Timeout set to 30,000 microseconds (30ms)

    # Calculate distance in centimeters
    distance_cm = (duration / 2) / 29.1

    return distance_cm


while True:
    try:
        distance = measure_distance()
        print("Distance:", distance, "cm")
    except OSError:
        print("Error reading from sensor")

    # Wait for some time before the next measurement
    time.sleep(1)