esp32之超声波测距

from machine import Pin
import time

trig=Pin(19,Pin.OUT,value=0)
echo=Pin(18,Pin.IN,value=0)

def measure():
    #发出开始测距信号
    trig.value(1)
    time.sleep_us(10)
    trig.value(0)
    #定时器计时
    while echo.value()==0:
        t1 = time.ticks_us()
    while echo.value()==1:
        t2 = time.ticks_us()
    t3 = time.ticks_diff(t2, t1) / 10000
    return t3 * 170

while True:
    print("当前距离:%0.2f cm" % measure())
    time.sleep(1)