實驗目的
了解超聲波模塊的工作原理
學習使用超聲波模塊測量距離
實驗器材
TPYBoard v202 1塊
超聲波模塊(HC-SR04)1個
micro USB數據線 1條
杜邦線 若干
超聲波模塊的介紹
實物圖
工作原理
(1) 采用IO口Trig觸發測距,給最少10us的高電平信號。
(2) 模塊自動發送 8 個 40khz 的方波,自動檢測是否有信號返回。
(3) 有信號返回,通過 IO 口 Echo 輸出一個高電平,高電平持續的時間就是超聲波從發射到返回的時間。測試距離=(高電平時間*聲速(340M/S))/2。
硬件連接
TPYBoard v002與超聲波模塊的接線圖,如下:
TPYBoard v202 |
超聲波模塊(HC-SR04) |
+5V |
Vcc |
G5 |
Trig |
G4 |
Echo |
GND |
Gnd |
程序源碼如下:
from machine import Pin import time
Trig = Pin(5,Pin.OUT) Echo = Pin(4,Pin.IN)
while True:
Trig.value(1) time.sleep_us(20) Trig.value(0) while(Echo.value()==0): Trig.value(1) time.sleep_us(20) Trig.value(0) if(Echo.value()==1): ts=time.ticks_us() while(Echo.value()==1): pass te=time.ticks_us() tc=te-ts distance=(tc*0.034)/2 print('Distance:',distance,'cm') time.sleep(2) |
經測試,發現存在一點誤差,還請大家多多指正。