雙超聲波防撞小車系統(tǒng)設(shè)計
1 引言
超聲波傳感器因其測量精度高、 響應(yīng)快和價格低廉而得到了廣泛應(yīng)用,傳統(tǒng)應(yīng)用方式是1 個發(fā)射頭對應(yīng)1 個接收頭 ,也有多個發(fā)射頭對應(yīng)1 個接收頭。但我們在實際應(yīng)用中發(fā)現(xiàn),如果障礙物的面很大(如墻壁),超聲波傳感器可以用來準確測距,但若將其應(yīng)用在小車防撞系統(tǒng)中,由于障礙物呈柱狀,而超聲波發(fā)射頭有一定的散射角(左右),因此即使障礙物不在小車正前方,超聲波仍能檢測到斜前方回波,這就給智能控制車輛行進帶來困難和誤導(dǎo),為了解決這一問題,我們提出了一種使用雙接收頭的方案,并從實用角度給出了一套具體控制策略。
本文提出了一種基于單片機控制的超聲波定位前方物體的監(jiān)測控制系統(tǒng)。通過一左一右的雙超聲波接收頭檢測信號,送單片機進行數(shù)據(jù)計算處理,能夠精確計算與障礙物的距離,同時判斷該障礙物是否位于車輛行徑的路線上。從而能保證車輛行駛中能準確避障。實驗測試系統(tǒng)表明,該系統(tǒng)有效距離可達8m,測量精度可達0.05m,小車能自由避開前方障礙物,或遇到障礙物時緊急剎車停下, 但不會因為障礙物在小車斜方向而誤判停止。
2 系統(tǒng)的結(jié)構(gòu)流程設(shè)計
我們的整個系統(tǒng)需要完成測距,測速,定位,控制小車運動等功能,系統(tǒng)包括如下六部分: 超聲波發(fā)射電路, 超聲波接受電路,信號處理器,溫度測量,小車控制電路等五部分。系統(tǒng)結(jié)構(gòu)框圖如圖一所示:
圖1:系統(tǒng)結(jié)構(gòu)框圖
通過單片機產(chǎn)生40k 的方波,經(jīng)過放大后驅(qū)動超聲波傳感器發(fā)射頭,從而發(fā)出超聲波,遇到前方物體反射后由接收端捕捉,經(jīng)過對兩個接收頭捕捉時間的計算以及加入溫度補償,判斷最終前方小車的方向與距離,再通過與前次數(shù)據(jù)差分計算出其相對前車的速度,最后通過速度、距離以及位置三個數(shù)據(jù)進行智能控制,控制小車轉(zhuǎn)彎或減速慢行等。
具體的硬件組成為:MCU 采用AT89S52 單片機,P1.0 口輸出超聲波換能器所需的40K 方波信號,經(jīng)過反相器7404 后驅(qū)動傳感器,為了能使超聲波發(fā)射得更遠,我們并接了三個發(fā)射頭,利用外中斷0 口監(jiān)測超聲波接收電路輸出的返回信號,回波檢測采用紅外檢測集成芯片CX20106,顯示電路采用簡單的4 位共陽LED 數(shù)碼管,斷碼用74LS244,位碼用8550 驅(qū)動。測溫部分使用18B20 測出當(dāng)前的環(huán)境溫度用以判斷出超聲波傳播的速度。
3 MCU 算法控制
3.1 距離計算與方位判斷
單片機可以計算出發(fā)射與接收到超聲波之間的時間,根據(jù)測溫系統(tǒng)的實際測溫, 查找出在該對應(yīng)溫度下的聲速,計算出反射物距離兩接收端的距離。 理論上由以上兩個數(shù)據(jù)上就可以直接數(shù)學(xué)推導(dǎo)出該物體的空間位置(如圖2 和公式一、二所示)。
評論