超聲波傳感器是移動機器人避障,、測距常用傳感器之一,。傳感器安裝在機器人上時距離地面不能太近,,太近容易產(chǎn)生干擾信號,,而且容易將可以翻越的障礙物當(dāng)成無法逾越的障礙物,。傳感器兩探頭間的距離不能太遠也不能太近,,太遠測量誤差過大,太近串?dāng)_信號過強,。
機器人硬件系統(tǒng)主要包括:ARM處理器,、單片機、外圍接口電路,、機器人底盤以及電源等,,其中ARM處理器是上層的核心,51單片機是下層的核心,。硬件結(jié)構(gòu)框圖如圖1所示,。
圖1 硬件結(jié)構(gòu)框圖
移動機器人采用H橋控制方案,整體控制方案如圖2所示,。
圖2H橋控制方案
電機共有4路PWM輸出分別作為左右輪的驅(qū)動,,而通過2路PWM輸出可控制一個電機,兩個電機以并聯(lián)方式連接,。
當(dāng)L298N芯片使能信號ENABLE為高時,,輸出才隨輸入變化,否則為高阻態(tài),,所以焊接時,,ENABLE引腳及電源引腳VS均接電源VCC。
具體驅(qū)動過程為:通過編程由控制芯片經(jīng)PWM發(fā)出驅(qū)動信號,,PWM輸出作為L298N的輸入,,經(jīng)L298N轉(zhuǎn)換輸出控制信號使電機轉(zhuǎn)動,從而實現(xiàn)電動機的驅(qū)動,。
PWM輸出信號的高低則可以控制直流電機轉(zhuǎn)速,。當(dāng)占空比加大時,轉(zhuǎn)速升高,;占空比減小時,,轉(zhuǎn)速降低;當(dāng)PWM信號輸出占空比為0時可控制電機的停止,。
當(dāng)左輪停止,,右輪轉(zhuǎn)時,小車左轉(zhuǎn);當(dāng)右輪停止,,左輪轉(zhuǎn)動時,,小車右轉(zhuǎn)。而2路PWM輸出的正負順序轉(zhuǎn)換則可控制電機的正反轉(zhuǎn),,進而控制小車的前進和后退,。
系統(tǒng)軟件結(jié)構(gòu)如圖3所示。
圖3 系統(tǒng)軟件結(jié)構(gòu)
超聲波發(fā)射模塊設(shè)計
外加信號頻率等于兩壓電晶片的固有振動頻率時,,將會發(fā)生共振,,課題中采用的超聲波傳感器中心頻率為40kHz,因此在超聲波發(fā)射電路中,,通過軟件編程方式,,對單片機I/O口置高和置低,產(chǎn)生40kHz脈沖信號,,輸出到發(fā)射電路中,。由于AT89S51單片機I/O口使用時能提供20mA灌電流能力,,而吸電流能力較小,,所以用74HC04來提高其輸出電流的能力,,保證40kHz的脈沖信號有一定的功率,。超聲波發(fā)射模塊原理圖如圖4所示,。
圖4 超聲波發(fā)射模塊原理圖
超聲波接收模塊設(shè)計
如圖5所示,,超聲波接收處理電路采用集成電路CX20106. CX20106接收到與其中心頻率相符的信號時,, 7腳就輸出低電平。 7腳輸出的脈沖下降沿和紅外傳感器測距信號相與后接單片機中斷口,。
圖5 超聲波接收電路原理圖
反射式紅外傳感器檢測系統(tǒng)設(shè)計
紅外測距電路如圖6所示, LM567可以構(gòu)成低頻振蕩器作為紅外傳感系統(tǒng)的編碼電路,,即利用其內(nèi)部的壓控振蕩器來產(chǎn)生低頻信號,由于R25=10.9kΩ,, C25=2200pF,根據(jù)公式f0 =1/1.1RC,,5腳輸出頻率38.91kHz的脈沖信號,。此脈沖信號使三極管T1(8050)工作于開關(guān)狀態(tài),,驅(qū)動紅外發(fā)光二極管發(fā)出的紅外脈沖。采用這種方法省去了信號發(fā)生電路,,簡化了線路和調(diào)試工作,,又防止了周圍環(huán)境變化和元件參數(shù)變化對收發(fā)頻率造成的差異,實現(xiàn)了紅外線發(fā)射與接收工作頻率的同步自動跟蹤,,使電路的穩(wěn)定性和抗干擾能力大大加強,。
圖6 反射式紅外傳感器測距原理圖