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

trig = Pin(5, Pin.OUT)
echo = Pin(18, Pin.IN)

def read_distance_cm():
    trig.value(0)
    sleep_us(2)
    trig.value(1)
    sleep_us(10)
    trig.value(0)
    duration = time_pulse_us(echo, 1, 30000)  # حداکثر ۳۰ میلی‌ثانیه انتظار
    if duration < 0:
        return None  # تایم‌اوت / پاسخی دریافت نشد
    return (duration * 0.0343) / 2

while True:
    d = read_distance_cm()
    if d is not None:
        print("فاصله: {:.1f} سانتی‌متر".format(d))
    else:
        print("پاسخی دریافت نشد")
    sleep(0.5)