from machine import Pin
import machine
import time

echoTimeout = 23200# 等待截止時間
#GPIO 18 設為輸出，接超音波的Trig腳
trigPin = Pin(25, Pin.OUT)
#GPIO 19 設為輸入，接超音波的Echo腳
echoPin = Pin(26, Pin.OUT)
trigPin.value(0)# 將Trig腳的電壓預設為低電位

# 設定一測試距離的自定義副函式，單位為公分
def distance():
    trigPin.value(1)
    time.sleep_us(10)
    trigPin.value(0)

    pulseTime = machine.time_pulse_us(echoPin, 1, echoTimeout)
    if pulseTime > 0:
        return pulseTime / 58
    else:
        return pulseTime

while True:
    cm = distance()# 開始測距
    if cm > 0:
        print('Distance:', cm, 'cm')
    else:
        print('Out of the detection range.')
        
    time.sleep(1)