# Echo -> 34
# Trig -> 25

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

def read_sensor(trig,echo):
    trig.value(0)
    sleep_us(5)
    trig.value(1)
    sleep_us(10)
    trig.value(0)


    pulse_time = time_pulse_us(echo, 1, 500*2*30)
    cm = pulse_time*0.017   # 1cm each 29.1us
    return cm

trig = Pin(25, mode=Pin.OUT)
echo = Pin(34, mode=Pin.IN)

while True:
    distance = read_sensor(trig,echo)
    print(f'Distance = {distance}')
    time.sleep(1)