from machine import Pin
from utime import sleep, sleep_us, ticks_us, ticks_diff

trig = Pin(4, Pin.OUT)
echo = Pin(2, Pin.IN)

while True:
    # tunggu 5 us
    sleep_us(5)
    #aktifkan trigger
    trig.value(True)
    #aktifkan trigger selama 10 us
    sleep_us(10)
    #matikan trigger
    trig.value(False)
    
    #menunggu echo untuk aktif(True)
    while echo.value() == False:
        pass
    #menandai waktu echo aktif
    timerStart = ticks_us()
    
    #menunggu echo nonaktif(false)
    while echo.value() == True:
        pass
    #menandai waktu echo aktif
    timerEnd = ticks_us()
    
    #menghitung lama waktu echo aktif
    duration = ticks_diff(timerEnd,timerStart)
    distance = duration*0.017
    print("jarak benda = ", distance)
    sleep(1)