基于光電傳感和路徑記憶的智能車(chē)導航系統

基于路徑記憶算法的轉向及驅動(dòng)控制策略，在電源管理、噪聲抑制、驅動(dòng)優(yōu)化等方面也都進(jìn)行了研究工作，通過(guò)大量的仿真試驗、道路試驗和基礎性能測試，開(kāi)發(fā)了基于光電傳感和路徑記憶的智能車(chē)導航系統，為整車(chē)系統的優(yōu)良性能奠定了堅實(shí)基礎。本文將從該智能車(chē)總體方案、路徑識別方案選擇、轉向和驅動(dòng)控制及路徑記憶算法等方面進(jìn)行介紹。

智能車(chē)總體方案

智能車(chē)系統以飛思卡爾公司的MC68S912DP256為核心，由電源模塊、傳感器模塊、直流電機驅動(dòng)模塊、轉向電機控制模塊、控制參數選擇模塊、單片機模塊等組成，如圖1所示。智能車(chē)系統工作電壓由+1.6V、+5V、7.2V三個(gè)系統混合組成，其中7.2V用于給驅動(dòng)電機和轉向舵機供電，5V給車(chē)速傳感器、MCU以及光電傳感器接收管供電，1.6V給發(fā)光管供電。為了在線(xiàn)控制參數的調整方便，還設置了一個(gè)控制參數選擇模塊，可以通過(guò)幾個(gè)按鍵的設置，調用不同的程序或控制參數，以適應不同場(chǎng)地條件的要求。



圖1 智能車(chē)總體結構

智能車(chē)的工作模式是：光電傳感器探測賽道信息，轉速傳感器檢測當前車(chē)速，電池電壓監測電路檢測電池電壓，并將這些信息輸入單片機進(jìn)行處理。通過(guò)控制算法對賽車(chē)發(fā)出控制命令，通過(guò)轉向舵機和驅動(dòng)電機對賽車(chē)的運動(dòng)軌跡和速度進(jìn)行實(shí)時(shí)控制。

想要取得智能車(chē)比賽的好成績(jì)，模型車(chē)底盤(pán)參數優(yōu)化和硬件設備的可靠性是非常重要的。其中，前輪定位參數優(yōu)化、轉向舵機力臂增大和底盤(pán)重心位置調整對于車(chē)模的機械性能有著(zhù)較大的影響。底盤(pán)參數的優(yōu)化參見(jiàn)，本文不贅述。

路徑識別方案選擇與電路設計

路徑識別方案是首先需要確定的，主要有以下幾個(gè)問(wèn)題。

*光電識別還是攝像頭識別；
*傳感器如何排列？間隔多大、形狀如何、單排還是雙排；
*傳感器可向前探測的遠度；
*傳感器信號采用數字式還是模擬式；
*電路上如何實(shí)現。

由于光電識別方案簡(jiǎn)單可靠，因此本文采用了光電識別方案。

數字式光電識別與模擬式光電識別

比賽組委會(huì )要求傳感器個(gè)數最多為16個(gè)，除掉1個(gè)轉速傳感器，可用于探測路徑的傳感器為15個(gè)，而傳感器允許布置的總寬度為25cm，如果采用數字式光電傳感器均勻分布，對道路的探測精度只能達到17mm左右，這樣賽車(chē)在前進(jìn)過(guò)程中很難達到很高的控制精度和響應速度。從本質(zhì)上講，數字式光電傳感器的劣勢就在于它丟掉了路徑探測中的大量信息。

模擬式光電傳感器從理論上可以大大提高路徑探測精度。模擬式光電傳感器的發(fā)光和接收都是錐角一定的圓錐形空間，其電壓大小與傳感器距離黑色路徑標記線(xiàn)的水平距離有定量關(guān)系：離黑線(xiàn)越近，電壓越低，離黑線(xiàn)越遠，則電壓越高(具體的對應關(guān)系與光電管型號以及離地高度有關(guān))，如圖2所示。



圖2 傳感器電壓與偏移距離關(guān)系示意圖