設計是以stc單片機為主控制器,然后再結合超聲波測距的原理,實現智能小車的實時跟隨控制。超聲波的發射模塊由單片機來控制時序,然后往前方發散從而尋找需要定位的節點并且會通過超聲波信號與射頻信號間的時間差計算發射點與需要定位節點間的距離。根據小車與障礙物距離的長短確定小車的運行。
關鍵詞:超聲波;測距
超聲波跟隨小車
【專科組】
一、系統方案本系統主要由超聲波模塊、電機驅動模塊、系統控制模塊、電源模塊組成,下面分別論證這幾個模塊的選擇。
1、超聲波模塊的論證與選擇方案一:HC-SR04
HC-SR04超聲波測距模塊可提供2cm-400cm的非接觸式距離感測功能,測距精度可達高到3mm;模塊包括超聲波發射器、接收器與控制電路。
方案二:US-100
方案一:雙L298驅動模塊
L298采用SMT工藝穩定性高,采用高質量鋁電解電容,使電路穩定工作。可以直接驅動兩路3-16V直流電機,并提供了5V輸出接口(輸入最低只要6V),可以給5V單片機電路系統供電(低紋波系數),支持3.3V MCU ARM控制,可以方便的控制直流電機速度和方向,也可以控制2相步進電機,5線4相步進電機。

雙L298驅動原理圖
方案二:智能車電機驅動模塊
BTS7960是應用于電機驅動的大電流半橋高集成芯片,它帶有一個P溝道的高邊MOSFET、一個N溝道的低邊MOSFET和一個驅動IC。P溝道高邊開關省去了電荷泵的需求, 因而減小了EMI。集成的驅動IC具有邏輯電平輸入、電流診斷、斜率調節、死區時間產生和過溫、過壓、欠壓、過流及短路保護的功能。

BTS7960驅動原理圖
L298驅動能力有限,芯片內阻很大,負載稍大發熱嚴重,利用率非常低,但用于驅動智能小車的電機足夠了,價格合適,經濟實惠。BTS7960驅動能力大(相對l298而言),但此芯片英飛凌已經停產,市面是大多是翻新貨,品質良莠不齊,且價格高,綜上所述,選擇方案一
4、控制系統的論證與選擇

通過超聲波發射裝置發出超聲波,根據接收器接到超聲波時的 時間差就可以知道距離了。 超聲波發射器向某一方向發射超聲波,在發射時刻的同時開始計時,超聲波在空氣中傳播,途中碰到障礙物就立即返回來,超聲波接收器收到反射波就立即停止計時。(超聲波在空氣中的傳播速度為340m/s,根據 計時器記錄的時間t,就可以計算出發射點距障礙物的距離(s),即:s=340t/2)
2、跟隨的分析與計算超聲波發射器向某一方向發射超聲波,在發射時刻的同時開始計時,超聲波在空氣中傳播,途中碰到障礙物就立即返回來,超聲波接收器收到反射波就立即停止計時。(超聲波在空氣中的傳播速度為340m/s,根據 計時器記錄的時間t,就可以計算出發射點距障礙物的距離(s),即:s=340t/2)當小車與障礙物距離小于20cm時,小車后退;大于20cm小于40cm時,小車停止;大于40cm時,小車前進。從而達到小車跟隨障礙物的目的。
三、電路與程序設計1、電路的設計(1)系統總體框圖
1、程序功能描述
根據題目要求軟件部分主要實現超聲波測距與超聲波跟隨。
1)超聲波測距:超聲波模塊發射接收信號的時間與超聲波在空氣中的傳播速度算出距離s=340t/2。
2)超聲波跟隨:通過小車與障礙物的距離控制小車的運行。
2、程序設計思路
超聲波發射器向某一方向發射超聲波,在發射時刻的同時開始計時,超聲波在空氣中傳播,途中碰到障礙物就立即返回來,超聲波接收器收到反射波就立即停止計時。(超聲波在空氣中的傳播速度為340m/s,根據 計時器記錄的時間t,就可以計算出發射點距障礙物的距離(s),即:s=340t/2)當小車與障礙物距離小于20cm時,小車后退;大于20cm小于40cm時,小車停止;大于40cm時,小車前進。
(2)程序流程圖1、主程序流程圖

四、測試方案與測試結果1、測試方案
測距結果如下表所示: (單位/cm)
距離 | 5 | 7 | 9 | 13 | 15 | 17 |
顯示 | 4.9 | 7.12 | 9.05 | 12.87 | 15.0 | 17.1 |
小車可以跟著障礙物運行
(2)測試分析與結論
本次制作超聲波跟隨小車,實現了超聲波測距,串口顯示,超聲波跟隨的功能。滿足了制作要求。
通過這次制作,我們小組都收獲頗多。剛開始的時候遇到許多困難,但經過我們的努力,克服了重重困難,最終制作成功。這次制作超聲波跟隨小車不僅用到了以前學到的知識,還讓我們學到了很多之前沒有接觸過的內容,讓我們受益匪淺,同時也鍛煉了我們的動手能力,讓我們對單片機有了更進一步的認識。當然由于水平有限,小車存在些許不足。在制作過程中,由于有些模塊的損壞,程序的不精確,給我們的制作過程造成了很大的困擾,我們通過與其它小組的交流探討,查閱資料,更換模塊,逐步修改,并進行了多次實踐,終于制作成功。通過此次制作,我們不僅在理論知識方面豐富了自己,同時在實踐中也拓展了自己的思維方式。對于今后的課題制作是大有裨益。
超聲波跟隨小車實驗報2告.doc
(659 KB, 下載次數: 84)
| 歡迎光臨 (http://m.raoushi.com/bbs/) | Powered by Discuz! X3.1 |