雷楊，趙玉榮，王亓劍，張自強

（安徽新華學院電子通信工程學院，安徽合肥，230088）

0 引言

導航系統(tǒng)對自動駕駛的重要性日益凸顯，車輛導航系統(tǒng)不僅可以確定車輛的最優(yōu)路徑，而且可以實時監(jiān)測車輛的速度和加速度。該智能車導航系統(tǒng)使用視覺導航圖像傳感器獲取路徑信息，再傳輸?shù)教幚砥髦羞M行處理，對信息圖像進行二值化，根據(jù)小車與目標的位置，求得相對位置的偏移角度，并傳送給車體。車體再將接收到的圖像信息與陀螺儀獲取的數(shù)據(jù)相結(jié)合，控制轉(zhuǎn)向；速度傳感器獲取實時速度，采用增量式PID實現(xiàn)對電機的閉環(huán)控制，最終實現(xiàn)一套自主路徑規(guī)劃導航控制系統(tǒng)[1]。

1 系統(tǒng)設(shè)計方案

整個系統(tǒng)主要由圖像采集平臺和智能車平臺兩個部分組成。圖像采集平臺主要實現(xiàn)攝像頭數(shù)據(jù)的采集、處理和無線傳輸系統(tǒng)，智能車平臺主要有K60單片機最小系統(tǒng)、避障模塊、電機驅(qū)動模塊、無線傳輸模塊、陀螺儀模塊等組成?？傮w設(shè)計結(jié)構(gòu)框如圖1所示。

圖1 系統(tǒng)設(shè)計方案

2 系統(tǒng)硬件設(shè)計

2.1 圖像采集處理器

圖像采集主控芯片采用STM32F767。其體積小，性能穩(wěn)定，具有ARM32位Cortex-M7高性能CPU，工作頻率高達216MHZ，內(nèi)嵌1024KB的高速FLASH閃存程序存儲容量。具有睡眠、待機和關(guān)機三種模式使其具備較低的功耗；芯片有2個數(shù)模轉(zhuǎn)換器，多達132個快速I/O端口且所有端口均支持5V信號，同時具備兩個支持SMBus/PMBus的I2C接口、8個USART接口、6個18M位/秒的SPI接口、CAN接口和MicroUSB接口。核心板內(nèi)部資源豐富，各模塊相對獨立[2]。將攝像頭采集來的圖像數(shù)據(jù)，通過NRF24L01無線傳感模塊傳輸給地面的智能車。

2.2 紅外攝像頭MT9V032

圖像采集對小車導航避障系統(tǒng)工作的穩(wěn)定性和高效性起著重要的影響。設(shè)計過程中綜合對比后采用了紅外廣角攝像頭MT9V032。MT9V032具有感光面積大、高動態(tài)性能、自動曝光、幀率可調(diào)等諸多優(yōu)點。

紅外攝像頭主要通過檢測智能車車身前后安裝的兩個大小不同的紅外圓形標記點來確定小車的坐標和車身角度信息。為此攝像頭加裝了850nm紅外窄帶濾光片，既能夠減少自然光的干擾減小誤判，又能更正廣角鏡頭產(chǎn)生的畸變，保證圖像畫面的清晰度。攝像頭排除其他光線的干擾只采集信標發(fā)射出的紅光與紅外光，增強了攝像頭識別系統(tǒng)的抗干擾性和魯棒性。

2.3 智能車核心處理器

MK60FX512VLQ15是智能車的主控芯片，該芯片是王者系列K60FX核心板，內(nèi)核為ARM-CORTEX-M4，主頻150MHz，1M的FLASH，128K的SRAM，內(nèi)置高分辨率的高速16位模擬轉(zhuǎn)換器ADC和2個12位數(shù)模轉(zhuǎn)換器DAC。16個DMA通道，用于外設(shè)和寄存器，實現(xiàn)數(shù)據(jù)的快速吞吐。此外MK60FX512VLQ15還具有豐富的模擬外設(shè)，包括3個SPI模塊，2個I2C，UART，CAN總線，USB接口等。

智能車平臺主要由主控制器和驅(qū)動電路組成。主板具有信號采集、處理和電機控制單元。同時，為了減少電機驅(qū)動電路的干擾，將控制部分和電機驅(qū)動分開。車身整體硬件包括超聲波紅外測距模塊、角度傳感器、速度傳感器、NRF24L01無線通信模塊等。通過測距傳感器對車體周圍信息進行檢測，獲取路況中障礙物的距離信息，確保避障系統(tǒng)的穩(wěn)定運行，車身頭部和尾部還配備了兩塊圓形紅外LED燈盤，一大一小供紅外攝像頭檢測，通過測算兩紅外的坐標并進行大小比較和兩坐標的斜角計算，就能確定車模的整體位置和角度信息，最終在各個模塊的配合下實現(xiàn)了一套能夠識別信標位置自主路徑規(guī)劃，并且可以實時輸出車體狀態(tài)的智能車導航控制系統(tǒng)。

3 系統(tǒng)軟件設(shè)計

智能車導航系統(tǒng)設(shè)計主要分圖像識別系統(tǒng)和智能車控制系統(tǒng)，首先智能車先通過攝像頭采集路面信息進行坐標計算，圖像采集時可能會出現(xiàn)邊緣雜點、邊緣線，遠景圖像模糊、變形等問題，造成圖片信息不真實，這就需要利用Matlab來校正圖像，圖像校正后在確定采集到三個發(fā)光源后，計算出偏移角，再將采集分析后的數(shù)據(jù)發(fā)送給智能車。智能車控制系統(tǒng)根據(jù)接收到的數(shù)據(jù)后執(zhí)行相應(yīng)的操作，例如前后車燈的亮滅控制、舵機打角計算及電機的正反轉(zhuǎn)。系統(tǒng)整體軟件設(shè)計流程如圖2所示。

圖2 整體設(shè)計流程圖

3.1 圖像采集與校正

攝像頭在拍攝圖像時，由于鏡頭的特點（凸透鏡會聚光、凹透鏡發(fā)散光），其成像過程是對真實鏡像的一種透視失真，智能車采用的是170°廣角攝像頭，圖像產(chǎn)生的桶形失真相對嚴重，沿著鏡頭半徑方向向邊緣移動畸變會越來越嚴重。本設(shè)計利用棋盤式方格進行測量，創(chuàng)建函數(shù)矯正桶形畸變還原真實賽道信息。筒體變形的數(shù)學模型參考公式（1）。

原始圖像是一個二維數(shù)據(jù)矩陣，每個元素對應(yīng)一個像素，計算量較大，可以利用Matlab仿真生成桶形畸變校正表，主控芯片只要查表找點即可。

3.2 目標識別

攝像頭采集到圖像后，圖像采集平臺對變換后的圖像按行跳躍式掃描，只掃描原始圖像的一半像素點，縮短掃描時間，基本思想如下：

(1)根據(jù)設(shè)定的閾值提取黑白跳躍點，按照掃描出連續(xù)目標區(qū)域的個數(shù)，記錄每個區(qū)域的長度和中心點坐標；

(2)利用賽道的連續(xù)性，根據(jù)上一行白塊中心的位置來確定本行的白塊與上一行白塊區(qū)域是否為同一區(qū)域，如果是便累加長度作為白塊面積，不是便建立新的白塊區(qū)域；

(3)整幅圖像掃描完成后對前三個白塊區(qū)域的各行中點求平均值，采集到的白塊區(qū)域超過三個便識別錯誤舍去；

(4)比較三個白塊的像素面積并重新排序，連同識別的目標數(shù)量按從小到大的順序一起發(fā)給小車；

(5)智能車根據(jù)白塊大小來確定信標、車頭與頭尾，其中面積最小的為車尾，再拿車尾的燈與另外兩個燈的距離作比較，較遠的為信標，較近的便是車頭。

3.3 路徑規(guī)劃

目標識別后小車需要以最快的速度準確的到達目的地，這就需要對路徑進行優(yōu)化，路徑優(yōu)化主要考慮以下三個方面：

(1)增加小車視場的長度和寬度

當采集到的圖像略大于整個賽道時，攝像頭采集到的目標畸變較小，此時小車會選擇一個較好的路徑快速滅掉信標且不出攝像頭視野；相反，如果視場無法覆蓋整個賽道，小車很容易沖出賽道檢測不到信標位置。雖然增大視場可以減少失真但提高了分辨率的要求，所以本設(shè)計采用STM32F767主控制器，其自帶攝像頭接口，方便操作。為了增加視場的寬度和每行采集的圖像點數(shù)，攝像頭使用廣角鏡頭來有效地增加視場的寬度。既滿足圖像采集的要求，又增加了單片機處理的圖像行數(shù)，最終處理行數(shù)為240行。

(2)相對角度處理

圖像采集平臺將采集到的坐標信息按從小到大進行排序，并將其與檢測到目標數(shù)量一同發(fā)給小車，小車在接收到數(shù)據(jù)后會比較最小的信標與另外兩個信標的距離，通過距離大小來區(qū)別信標燈和車頭。最后分別算出車尾與車頭，車尾與信標燈相對圖像的角度，兩個角度相減便得到小車與信標燈的角度差。

(3)切向滅燈與避障

行駛過程中小車速度較快，為了避免小車撞上信標，在足夠靠近信標時，讓小車與信標形成一個切向角度沖過去。外界光線結(jié)合賽道地面材料的反光容易對攝像頭造成干擾，影響采集數(shù)據(jù)的準確性，容易造成碰撞因此車前裝有三個超聲波模塊和兩個GP2Y0A21YK0F 紅外測距傳感器，再通過模數(shù)轉(zhuǎn)換將數(shù)據(jù)發(fā)送給小車，可能的排除干擾。

4 測試

為了驗證該智能車導航系統(tǒng)定位的效果，在室內(nèi)選擇了一塊較為空曠的場地，并在空地上方安裝了圖像采集平臺，地面鋪設(shè)了可發(fā)射紅外光的信標供攝像頭識別，信標鋪設(shè)的位置預(yù)先經(jīng)過測量，布設(shè)在鏡頭邊緣等畸變嚴重、識別難度較高的區(qū)域，并在鏡頭視野內(nèi)擺放了一些雜物干擾智能車的行駛路徑。

實驗表明，小車會根據(jù)傳輸過來的圖像信息對亮著的信標燈進行目標識別并且規(guī)劃路徑，向著目標燈行駛過去。同時根據(jù)路面以及環(huán)境信息，電機會根據(jù)控制算法自動調(diào)整速度。在第一盞燈被滅掉之后，在下一盞燈與現(xiàn)處的位置之間放置隨意一物體當作障礙，小車會自動完成避障功能并且駛向下一個目標區(qū)。

5 小結(jié)

本文從總體硬件結(jié)構(gòu)和系統(tǒng)軟件設(shè)計兩方面分析了智能車輛的視覺定位與導航技術(shù)。將視覺傳感器與車身分離出來，使之視角更為廣闊，對于控制地面車輛的行駛具有更高的前瞻性。該系統(tǒng)設(shè)計可以讓智能車在GPS覆蓋不到的區(qū)域能夠感應(yīng)并靠近遠距離終點目標。由于攝像頭感應(yīng)處理的是紅光與紅外光，對于外界自然光具有極強的抗干擾性，能夠適應(yīng)不同的工作場合，相比傳統(tǒng)的導航方式，本設(shè)計在路徑規(guī)劃、障礙躲避、功能拓展方面具有較大優(yōu)勢，具有一定的創(chuàng)新與研究意義。