王加安,戴鵬,蔣波文
(常州工學(xué)院,江蘇常州,21300)
在智能化飛速發(fā)展下,智能小車應(yīng)用廣泛,能包括自動駕駛汽車,盲人出行導(dǎo)航車,自動化物品運載車,電力運行故障檢查車,車間內(nèi)的自動運輸車,除此之外在軍事領(lǐng)域智能小車也有著廣泛地應(yīng)用,如作為練習(xí)訓(xùn)練時的移動標靶,自動排雷車,彈藥輸送車等?;跀z像頭的智能小車系統(tǒng)充分利用了攝像頭傳感器替代人眼采集的信息完整,檢測范圍寬,并且成本低的優(yōu)點。攝像頭采集到的道路圖像包含了行駛路線的邊緣以及路徑走向趨勢等信息,能夠通過單片機核心進行預(yù)處理。因此,這種獲取道路信息并處理的方法使得智能小車自動行駛的效果更加顯著。智能駕駛小車運用圖像處理技術(shù)在未來小車實現(xiàn)智能化的過程中十分重要。小車獲取道路信息是能夠?qū)崿F(xiàn)各種復(fù)雜操作的先決條件。智能小車的自動駕駛技術(shù)采用了自動控制原理、電子技術(shù)、圖像處理技術(shù)、傳感器技術(shù)等多種技術(shù)融合的方式[1]。
智能小車控制系統(tǒng)選用Infineon SAK-TC264DA-40F200W作為控制器,以MT9V034[8]神眼攝像頭作為智能小車的道路信息采集模塊,將信息數(shù)據(jù)傳送給主控芯片,采用圖像二值化處理[9]后將圖片轉(zhuǎn)換為計算機可識別的黑白圖片[10]并在黑白圖片劃取中心線作為小車行駛的道路標志的路徑線,同時將處理后的路徑圖像信息數(shù)據(jù)實時顯示在OLED[11]屏幕上,通過增量式PID[2]算法控制小車速度調(diào)節(jié),位置式PID 算法控制小車轉(zhuǎn)向,確保小車準確行駛[12-14]。小車系統(tǒng)整體結(jié)構(gòu)圖如圖1 所示。
圖1 系統(tǒng)整體結(jié)構(gòu)圖
采用7.2V的鎳鎘動力電池作為小車的供電源,驅(qū)動電機工作的電壓是12V,主控芯片電路、攝像頭圖像傳感器電路及顯示模塊電路的工作電壓是+3.3V,由于各模塊的工作電壓不同,因此選用MC34063 升壓芯片和LM2596 降壓芯片,調(diào)節(jié)整體電路的不同電壓值,以此實現(xiàn)對系統(tǒng)的整體供電。其電路原理如圖2 所示。
圖2 供電原理圖
采用MC34063 芯片來獲得12V 電壓,為MOS 管的穩(wěn)定飽和提供高壓。其電路原路圖如圖3 所示。
圖3 驅(qū)動電路設(shè)計圖
直流電機的驅(qū)動采用IR2104 芯片的高電壓、高轉(zhuǎn)速動力的性能特點提供了12V 電壓的全橋雙路驅(qū)動電路,此電路大大提高了電動機的工作轉(zhuǎn)矩和轉(zhuǎn)速,其電路原理圖如圖4 所示。
圖4 雙路式驅(qū)動原理圖
該系統(tǒng)采用MT9V034 神眼攝像頭,具有自動曝光功能,可自由設(shè)置對比度、曝光時間、幀率、分辨率、增益等;在光線暗、日光等極端環(huán)境下也可以發(fā)揮該攝像頭的功能。
我們選用OLED 顯示屏,具有對比度高、視角廣、反應(yīng)速度快,通過I2C 總線的0.96 寸OLED 屏幕顯示二值化處理過的道路信息。
我們選用mini512 線增量式測速編碼器[15],對電機的速度進行實時測量,把電機的角位移轉(zhuǎn)換成周期性的電信號,更加便捷的實現(xiàn)了主控芯片對電機的控制。
我們給系統(tǒng)設(shè)置了九軸陀螺儀傳感器可以讓物體在運動過程中感知其水平、垂直、俯仰、航向和角速度等信息。利用該傳感器的特性,我們可以在物體三維運動中提煉出相關(guān)的角度和角速度,當(dāng)任意傳感軸上發(fā)生超出閾值的事件時,便會生成一個中斷,同時給蜂鳴器報警裝置,進行警告。
系統(tǒng)采用C 語言[16]編寫,主程序首先進行初始化,通過初始化后的攝像頭傳感器采集道路信息,對圖像進行大津法二值化處理,然后對圖像進行去噪處理[17],對處理完的圖像劃取中線,以獲取準確的道路信息。通過分析采集的圖像數(shù)據(jù),對小車的轉(zhuǎn)向以及速度進行控制,再由增量式PID 控制算法驅(qū)動電機運轉(zhuǎn),位置式PID 控制算法驅(qū)動舵機調(diào)整小車運行狀態(tài),從而達到自動行駛的功能。程序總體流程圖如圖5 所示。
圖5 系統(tǒng)工作流程圖
為了達到更好的速度控制效果,我們選用閉環(huán)控制的方式,通過閉環(huán)反饋使系統(tǒng)的精度提高,系統(tǒng)的響應(yīng)時間縮短,穩(wěn)定性提高。我們采用了增量式PID 作為速度閉環(huán)處理控制的算法。增量式PID 由于計算機輸出增量,所以誤動作的影響小,沖擊小。該算法不需要累加,控制增量su(k)的確定僅與最近k 次的采樣值有關(guān),所以較容易通過加權(quán)處理而獲得比較好的控制效果。
增量式PID 如式1 所示:
數(shù)字攝像頭可直接采集賽道灰度值,其中灰度值高的為白色,灰度低的為黑色,因此在圖像中的白色和黑色的灰度值會有較大區(qū)別,通過大津法分割閾值,從中分離出目標物體,在根據(jù)設(shè)定的閾值圖像中部向兩邊搜選黑白跳變點,從而確定左右邊界位置,并根據(jù)左右兩邊界計算出中心作為中心點,推算完整幅圖像的中心點后,將中心點進行處理,使其具有連續(xù)性。彎道的圖像處理如圖6 所示。
圖6 彎道圖像處理效果圖
該系統(tǒng)設(shè)計的基于TC264的智能小車,通過攝像頭采集道路信息,增量式編碼器檢測當(dāng)前的速度,將數(shù)據(jù)傳送給核心控制器,分析智能小車當(dāng)前行駛狀態(tài),實時控制。該系統(tǒng)采用模塊化的設(shè)計,經(jīng)過實際測試表明,智能小車能夠?qū)崿F(xiàn)自動駕駛功能,能夠通過設(shè)定的彎道、直道、環(huán)島等道路,本設(shè)計實現(xiàn)了一個具備速度控制、道路信息采集分析、自動駕駛功能的智能小車。