基于模塊化控制的多功能智能小車(chē)設計
通過(guò)嵌入模糊控制算法,實(shí)現小車(chē)精準尋跡;采用超聲波檢測障礙物使小車(chē)提前做出反應,繞過(guò)障礙物;設計靈敏度可調的趨光系統,驅動(dòng)小車(chē)趨光進(jìn)庫;通過(guò)金屬傳感器檢測金屬塊;利用霍爾器件測量小車(chē)行駛的路程;最終將金屬塊個(gè)數,行駛時(shí)間及路程顯示在液晶屏上,實(shí)現了友好的人機界面。實(shí)驗表明,智能小車(chē)系統能夠順利完成種各功能,在各獨立控制模塊上能達到較高的穩定性和精度要求。
0 引言
智能小車(chē)形式多樣,控制方法多變,創(chuàng )新性強,因此在電子競賽和科技創(chuàng )新方面一直受到熱捧。每年的“飛思卡爾”智能小車(chē)比賽中就分有電磁組,光電組,攝像頭組,分別通過(guò)電磁傳感器,光電傳感器,攝像頭來(lái)采集信號,檢測小車(chē)的循跡能力和運行速度;遙控小車(chē)也是在小車(chē)上裝上無(wú)線(xiàn)模塊來(lái)接收遙控端發(fā)來(lái)的信號,從而實(shí)現小車(chē)的智能化控制;滅火機器人則是在避障小車(chē)的基礎上加入趨光模塊和溫度傳感器,使小車(chē)趨向火源滅火。
鑒于目前基于智能小車(chē)的設計,大多都是功能單一的尋跡小車(chē),避障小車(chē)或遙控小車(chē),在此將設計一種將紅外對管尋跡、金屬檢測、超聲波避障、硅光電池趨光和距離測量集成在同一個(gè)系統中的多功能智能小車(chē),實(shí)現其多任務(wù)處理功能。同時(shí),本系統針對各模塊采用優(yōu)化控制方案,以期望得到更精準控制。整個(gè)智能小車(chē)系統具有高效率、高準確度、低成本等特點(diǎn)。
當前對智能小車(chē)系統的控制方法也是多種多樣,常見(jiàn)的有路徑記憶法,模糊控制法,圖像識別法等。
這些方法對于單任務(wù)的小車(chē)控制都能達到理想的效果。在本文所設計的智能小車(chē)系統中,將充分考慮小車(chē)的多任務(wù)性,采取模塊化控制方法來(lái)實(shí)現小車(chē)的多功能控制,并在模塊化的基礎上嵌套模糊控制的方法,使小車(chē)既滿(mǎn)足多功能要求,又能實(shí)現各控制模塊獨立、穩定運行。
1 系統結構設計
系統設計一般包括硬件設計和軟件設計。本系統中硬件設計由電源模塊、驅動(dòng)模塊、尋跡模塊、金屬檢測模塊、超聲波避障模塊、硅光電池趨光模塊和顯示模塊構成,系統的整體結構如圖1所示。
1.1 驅動(dòng)模塊
由單片機產(chǎn)生兩路PWM 波,通過(guò)L298N 電機驅動(dòng)芯片控制兩個(gè)直流電機,分別驅動(dòng)動(dòng)左輪和右輪。直走時(shí)兩路PWM 波頻率相位相同,當需要轉彎時(shí),改變PWM 波控制相應的電機反轉,另一電機正轉。兩邊形成差速即可實(shí)現轉彎。調整反轉的的時(shí)間,可以控制轉彎的大小和快慢,改變PWM 波的占空比可以控制小車(chē)的速度。
1.2 尋跡模塊
該模塊主要利用光電對管來(lái)檢測小車(chē)賽道上的黑線(xiàn)。當光電對管內的發(fā)光二極管位于黑線(xiàn)上時(shí),發(fā)光二極管發(fā)出的光被黑色吸收,不能被反射回來(lái),此時(shí),接收端上的光電三級管基極電壓為零,三極管不能導通,輸出低電平,與之相連的比較器同相端的也為低電平,最終輸入單片機對應引腳一個(gè)低電平。單片機檢測到輸入的低電平就會(huì )對電機進(jìn)行相應的處理,驅動(dòng)小車(chē)轉彎,使得這個(gè)光電對管偏離黑線(xiàn)。一旦離開(kāi)黑線(xiàn),光電三級光就能夠接受到光照,三極管導通輸出高電平,給單片機引腳輸入一個(gè)高電平,單片機檢測到該高電平后給相應電機正轉命令,小車(chē)恢復直線(xiàn)行駛。依此循環(huán),最終小車(chē)就能沿著(zhù)黑線(xiàn)所設定的的軌跡行駛。
設計尋跡模塊時(shí),為了減小環(huán)境光的干擾,可以在放大器的反向端接入一個(gè)滑線(xiàn)變阻器,通過(guò)調節電阻的大小,改變比較器的閾值電壓,從而改變傳感器的靈敏度。當較弱的環(huán)境光進(jìn)入到光電三極管的基極,三極管的集電極會(huì )有電壓,但只要調大滑線(xiàn)變阻器接入的阻值,使得環(huán)境光照射時(shí),集電極電壓低于閾值電壓,此時(shí)光電對管仍然輸出低電平,這樣就達到了消除環(huán)境光的目的。該電路接入的阻值越大,閾值越高,就越不容易受環(huán)境光的影響,但靈敏度也就越低,反應越慢。相反,就越容易受環(huán)境光影響,靈敏度越高,反應越快。
同時(shí),為了使小車(chē)能適應不同弧度的路線(xiàn),在循跡模塊中嵌入了模糊控制算法。首先建立一個(gè)模糊集合X={左偏,左較偏,左很偏,右偏,右較偏,右很偏},定義模糊規則:當左側第一個(gè)光電對管位于黑線(xiàn)上時(shí),定義小車(chē)右偏,小車(chē)左輪停轉,右輪正常轉動(dòng);當左側第二個(gè)光電對管位于黑線(xiàn)上時(shí),定義小車(chē)右較偏,小車(chē)左輪小幅度反轉,右輪正常轉動(dòng);當左側第三個(gè)光電對管位于黑線(xiàn)上時(shí),定義小車(chē)右很偏,小車(chē)左輪大幅度反轉,右輪正常轉動(dòng)。同理,對右側光電對管定義模糊規則。通過(guò)模糊控制小車(chē)就能適應多變的路線(xiàn)。
1.3 金屬檢測模塊
把金屬傳感器固定在小車(chē)底部,當小車(chē)經(jīng)過(guò)金屬片時(shí),金屬傳感器的輸出端會(huì )產(chǎn)生一次電頻跳變,將跳變信號輸入到單片機的外部中斷,每一次跳變,觸發(fā)一次中斷,單片機就會(huì )控制蜂鳴器發(fā)聲報警。將中斷次數記錄下來(lái)送到液晶顯示,就能得到檢測的金屬片個(gè)數。
1.4 超聲波避障模塊
用單片機給超聲波發(fā)生器輸入端輸入一列脈沖觸發(fā)信號,超聲波發(fā)生器的發(fā)射端就會(huì )產(chǎn)生一列對應頻率的超聲波,當聲波遇到障礙物(3 m以?xún)龋r(shí)就會(huì )反射回來(lái),被接收端接受,其輸出端輸出一系列PWM波。記錄這列PWM 波的高電平持續時(shí)間,并忽略小車(chē)在此段時(shí)間內的位移,就可計算出小車(chē)到障礙物的距離,當距離達到某一設定值時(shí),控制電機使小車(chē)轉彎,繞過(guò)障礙物。
本系統中充分利用Mega128 單片機的中斷捕捉功能,將超聲波發(fā)生器產(chǎn)生的輸出回響信號輸入到單片機,首先設置下降沿觸發(fā)捕捉中斷,定時(shí)器計時(shí)開(kāi)始,當中斷觸發(fā)時(shí)馬上更改觸發(fā)方式為上升沿觸發(fā),再次響應中斷時(shí)記錄此時(shí)定時(shí)器的值T1同時(shí)原計數值清零,此時(shí)記錄的高電平時(shí)間T1即為聲波在空中傳播的時(shí)間。再次更改觸發(fā)方式為下降沿觸發(fā),實(shí)現動(dòng)態(tài)實(shí)時(shí)測量。與傳統的中斷響應測量相比,中斷捕捉具有快速、精準的優(yōu)點(diǎn)假設單片機晶振為M,分頻系數為N,聲音的傳播速度為V.聲波傳播的時(shí)間為(單位:s):
因此,可以按照下式計算出距離障礙物的距離L1:
1.5 硅光電池趨光模塊
為了使小車(chē)具有更理想的趨光效果,本系統采用硅光電池作為傳感器。當光源照射到硅光電池的表面,硅光電池的電阻值會(huì )發(fā)生變化,光照強度越大,電阻值越小。在小車(chē)前端的左中右分別裝上一個(gè)硅光電池,將光管電池接在相同的參考電壓源上,將其兩端的電壓送入單片機的采樣通道轉化成數字量,通過(guò)比較三路采樣值的大小就能判斷出哪個(gè)方向上的光照強度大,從而控制小車(chē)直走或轉彎,進(jìn)而趨向光源。
pwm相關(guān)文章:pwm是什么
蜂鳴器相關(guān)文章:蜂鳴器原理
評論