自動尋跡智能車涉及到當前高技術領域內的許多先進技術，其中 主要的是傳感技術、路徑規劃和運動控製。本課題是以飛思卡爾智能車競賽為背景，以單片機作為 控(kong)製(zhi)單(dan)元(yuan)，以(yi)攝(she)像(xiang)頭(tou)作(zuo)為(wei)路(lu)徑(jing)識(shi)別(bie)傳(chuan)感(gan)器(qi)
，以(yi)直(zhi)流(liu)電(dian)機(ji)作(zuo)為(wei)小(xiao)車(che)的(de)驅(qu)動(dong)裝(zhuang)置(zhi)，以(yi)舵(duo)機(ji)控(kong)製(zhi)小(xiao)車(che)轉(zhuan)向(xiang)。車(che)模(mo)競(jing)賽(sai)的(de)賽(sai)道(dao)是(shi)一(yi)個(ge)具(ju)有(you)特(te)定(ding)幾(ji)何(he)尺(chi)寸(cun)約(yue)束(shu)、摩擦係數及光學特性的KT板
，其中心貼有對可見光及不可見光均有較強吸收特性的黑色條帶作為引導線
，寬度為2．5 cm。在(zai)行(xing)駛(shi)過(guo)程(cheng)中(zhong)，係(xi)統(tong)通(tong)過(guo)攝(she)像(xiang)頭(tou)獲(huo)取(qu)前(qian)方(fang)賽(sai)道(dao)的(de)圖(tu)像(xiang)數(shu)據(ju)，同(tong)時(shi)通(tong)過(guo)測(ce)速(su)傳(chuan)感(gan)器(qi)實(shi)時(shi)獲(huo)取(qu)智(zhi)能(neng)車(che)的(de)速(su)度(du)
，采(cai)用(yong)路(lu)徑(jing)搜(sou)索(suo)算(suan)法(fa)進(jin)行(xing)尋(xun)線(xian)判(pan)斷(duan)和(he)速(su)度(du)分(fen)析(xi)，然(ran)後(hou)作(zuo)控(kong)製(zhi)決(jue)策(ce)
，控(kong)製(zhi)轉(zhuan)向(xiang)舵(duo)機(ji)和(he)直(zhi)流(liu)驅(qu)動(dong)電(dian)機(ji)工(gong)作(zuo)。智(zhi)能(neng)車(che)通(tong)過(guo)實(shi)時(shi)對(dui)自(zi)身(shen)運(yun)動(dong)速(su)度(du)及(ji)方(fang)向(xiang)等(deng)進(jin)行(xing)調(tiao)整(zheng)來(lai)“沿”賽(sai)道(dao)快(kuai)速(su)行(xing)駛(shi)。本(ben)文(wen)主(zhu)要(yao)介(jie)紹(shao)攝(she)像(xiang)頭(tou)通(tong)過(guo)提(ti)取(qu)賽(sai)道(dao)黑(hei)線(xian)信(xin)息(xi)交(jiao)予(yu)單(dan)片(pian)機(ji)處(chu)理(li)，通(tong)過(guo)單(dan)片(pian)機(ji)輸(shu)出(chu)控(kong)製(zhi)信(xin)號(hao)控(kong)製(zhi)舵(duo)機(ji)轉(zhuan)向(xiang)來(lai)控(kong)製(zhi)車(che)模(mo)的(de)轉(zhuan)向(xiang)，從(cong)而(er)很(hen)好(hao)的(de)自(zi)動(dong)循(xun)跡(ji)。

 

1 總體軟硬件結構及思路

 

此智能車輛定位係統用攝像頭拍攝車輛前方的賽道，通過MC9S12XS128caiyangshipinxinhao
，huodetuxiangshuju。ranhouyongheshidesuanfa，rugenzongbianyuanjiancesuanfa
，fenxituxiangshuju


，tiqumubiaozhiyinxian。ranhou，xitonggenjumubiaozhiyinxiandeweizhixinxi
，duiduojihedianjishiyiheshidekongzhi。benzhinengcheyundongxitongdejiegouturutu1所示。

因為係統是一個有機的整體
，所以需配合好係統的攝像頭、控製單片機、電機（包括直流伺服電動機、光電編碼器）、舵機和輔助電路（電源板、電機驅動板）等各個部分。舵機是實時控製車模的轉向，是比賽快速性和穩定性的關鍵，舵機控製有很多的控製算法
，如：PID經典控製算法
、模糊算法
、算法等。

 

2 係統程序總體控製流程

 

係統的基本軟件流程是：首先，對各功能模塊和控製參數進行初始化；然後
，通過圖像采集模塊獲取前方賽道的圖像數據，同時通過速度傳感器模塊獲取賽車的速度。采用PIDduiduojijinxingfankuikongzhi。lingwaigenjujiancedaodesudu，jiehesudukongzhicelve，duisaichesudubuduanjinxingshidangtiaozheng，shisaichezaifuhebisaiguizedeqiantixia
，yansaidaokuaisuxingshi。xitongdejibenruanjianjiegouliuchengtu，rutu2所示。

 

 

係統的軟件要求控製的準確性
、穩定性。采樣提取黑線是控製輸入量的基礎，要求采樣的 穩定。輸入量給舵機以後又要求舵機輸出的快速相應性、穩定性和準確性。經過多次實驗及近一個學期的調車經驗，選用了並改進了經典的PID控製器對車模的舵機進行控製調節。

 

3 圖像識別

 

用CCD攝(she)像(xiang)頭(tou)采(cai)集(ji)車(che)模(mo)前(qian)方(fang)一(yi)定(ding)距(ju)離(li)內(nei)的(de)黑(hei)線(xian)，從(cong)中(zhong)提(ti)取(qu)相(xiang)關(guan)量(liang)，用(yong)來(lai)控(kong)製(zhi)舵(duo)機(ji)的(de)轉(zhuan)向(xiang)，實(shi)現(xian)智(zhi)能(neng)車(che)的(de)自(zi)動(dong)循(xun)跡(ji)。由(you)於(yu)單(dan)片(pian)機(ji)數(shu)據(ju)處(chu)理(li)能(neng)力(li)和(he)速(su)度(du)有(you)限(xian)，不(bu)能(neng)在(zai)短(duan)短(duan)的(de)20 ms時間內處理整場圖像。本係統設置攝像頭前瞻為1．2 m。在不影響道路檢測 需要的前提下

，本係統采用隔行采集來壓縮圖像數據，即相隔不同的有效行采集一行數據（近處相隔的少
，遠處相隔的多），一共可采集 44行數據。此外為了進一步提高A／D轉換的速度，本係統還適當地將XS12的CPU超頻運行並且設置A／D轉換器的 為8位，這樣每行能采樣到67個點，形成了一個麵陣，而黑線在其中占據了某些點位。由於我們一行采集67個點，故中間值為33。tuxiangshizhinengchedediceng，tuxiangdecaijizhengqueyufouzaiyihoudekongzhizhongyouweizhongyao，guyidingyaoquebaocaijihuilaideheixiandezhenshiyouxiaoxing，bingqieyaozengjialvbosuanfa，biruzaiyouxiaoqianzhanhenxiaodeshihou，benlaizhiyaopanduanchuheixiandezhuanxiangjike，geiduojiyijixianzhuanjiaokeyirangchejizhuanwan。danshiyouxiaoxinghenshaodeshihou
，ruguobuyongteshudelvbofangfa，zhiyaoyouyixingdeheixianticuo
，jiukenengrangxiaochezhuancuo，zhiyuzhuanchujie。

 

4 分段PID控製

 

4．1 圖像信息提取量

 

從采集回來的圖像中提取控製量來控製舵機的轉向
，實現智能車的自動循跡。本係統采用黑線偏移量even_diff和黑線某段斜率 D_diff-erent對舵機進行控製，可稱為PD控製器。由於車模是個隨動係統
，在攝像頭1．2 m前瞻內覆蓋的黑線不一定有設置的44行，特別是前方的彎特別急的時候，在攝像頭前瞻視角範圍內覆蓋的黑線會特別少
，比如13行或13行以下。根據這個特點
，可設置一個有效前瞻量valid_line作為對前方的彎的平緩程度的反應。

 

把每一行的黑線位置值與中間值作差，得到該行的偏移量，中間值33weisaidaodezhongxinweizhidian
，pianyiliangbiaoshizaichemodeshijiaoxiaheixianchuyusaidaozhongdeweizhizhi。bameiyixingdepianyiliangxiangjiazhihechuyishexiangtouqianzhanfanweineidetiquchudeheixianxingshu，dedaoheixianxiangduiyuchemozhongxindezhengtipianyiliangeven_diff，用有效行內的遠處某些行與近處某些行（如前半場與後半場）偏移量之差得到有效行內的黑線斜率D_differen。

 

這樣，從一場的黑線位置數據中，係統提取了有效行valid_line、even_diff
、D_different 3個量來對舵機進行控製。在實際情況中，D_differentkeyihenlinghuo，yinweiqianfangheixiandexielvkeyiqubutongduandedao，keyigenjushijiyaoqiudedaobutongduandexielvzhi
，rusudukuaishikeyishidangdequjuchejiaoyuanchudeheixianxielv，yishixianchaoqiankongzhi。

 

在智能車調試參數的時候，對這3個量的理解很是重要，具體來說
，valid_line表biao征zheng車che模mo的de有you效xiao前qian瞻zhan，即ji看kan得de有you多duo遠yuan，對dui於yu智zhi能neng車che在zai道dao路lu上shang行xing駛shi，看kan得de遠yuan說shuo明ming黑hei線xian都dou在zai前qian方fang，看kan不bu遠yuan說shuo明ming智zhi能neng車che前qian方fang的de黑hei線xian已yi經jing偏pian左zuo或huo者zhe偏pian右you

，而er這zhe個ge量liang的de大da小xiao正zheng好hao可ke以yi表biao征zheng彎wan的de平ping緩huan與yu急ji切qie。另ling外wai

，看kan得de遠yuan則ze攝she像xiang頭tou采cai集ji的de黑hei線xian多duo，係xi統tong信xin息xi量liang大da，那na麼me怎zen麼me處chu理li這zhe些xie大da量liang的de信xin息xi為wei我wo們men所suo用yong就jiu變bian得de很hen關guan鍵jian
，如ru看kan得de1．2 m都能看見
，說明小車必然在長直道上，不然也是小S彎
，稍作處理就可以過濾掉小S彎了，讓小車像都是在直道上跑
；看得很近說明彎已經很急，這時候
，隻要能夠判斷出彎往那邊拐就可以給舵機一個極值急拐。even_diff表征在某一個特定視野下
，小車與黑線偏離的程度，這個量可以讓智能車在某個特定視野下決定給舵機多大的轉角。D_different則在有效前瞻遠的時候尤為關鍵，因為它可以預判前方的彎，從而超前的轉彎。

 

4．2 PD控製器形式

 

係統把這3個量處理成PD控製器的形式：

 

 

 

其中a為根據賽道有效前瞻確定的不同有效行。Centre為舵機走直線的控製中間值。Steer為PD控製器給舵機的輸入量。由於車模舵機轉向控製是一個非線性係統
，而設置了入口條件“有效行判斷”

，正zheng好hao可ke以yi把ba這zhe個ge非fei線xian性xing係xi統tong分fen割ge成cheng不bu同tong段duan
，在zai每mei一yi段duan可ke近jin似si認ren為wei轉zhuan向xiang控kong製zhi係xi統tong是shi線xian性xing的de。即ji在zai某mou一yi小xiao段duan範fan圍wei內nei，得de到dao的de黑hei線xian位wei置zhi和he對dui應ying的de舵duo機jiPID參照角度處理成 線性關係。 終實現簡單分段PID控製。

 

5 分段PID控製參數規律

 

在實際的調車過程中，我們總結發現，PD控製器的參數Kp、Kd與有效前瞻valid_line
、車模的速度相關。簡單點說，即小車速度越快
，車模遇彎提前拐彎的應越早。總結下來，有如下關係：　 

 

其中A為Kp的基礎值，valid_line為車模運行到某個狀態的有效前瞻（用提取的黑線數量來估定），speed為小車一場時間內的脈衝值，表征車模時刻運行的速度。低速時，可近似認為speed／C為零，通過試驗法可以確定A值大小。在確定Kp基礎值之後，即可加速，在小車速度稍高的時候調試得出合適的B值、C值， 終使小車平穩準確的切線，循跡而行。此關係式可知，有效前瞻的變化是對Kp值影響 大也是 直接的一個量
，我們平時調車經驗而知，B參數應比C敏感很多才行。有效行減少一行，對舵機轉向角的影響要遠大於小車速度speed對Kp的對影響。而speed對舵機急轉快速性在車模高速的時候很是明顯。

 

為增加係統的魯棒性
，並且更好的解決係統的非線性問題，我們將小車的前瞻分段，我們1．2 m的前瞻裏麵，總共有44行黑線，直道上全部提取回來
，可以分為有效行37行一下
、有效行30行以上、有效行24行以上
、有效行18行以上
、有效行13行以上與有效行13行以下7段。

 

雖然分為7段，各段單獨控製，參數單獨調節，但是
，Kp值與有效行（有效前瞻）成負相關的關係仍然成立，故Kp、Kp1、Kp2
、Kp3、Kp4
、Kp5依然大體上遵循與有效行負相關的關係，即Kp隨有效行的減小線性增加。

 

在每一段裏麵調節PD控製器的參數
，使小車能夠行使不同類別不同半徑的彎道。這樣就形成分段PD控kong製zhi，小xiao車che的de非fei線xian性xing問wen題ti可ke以yi很hen好hao的de解jie決jue，係xi統tong的de魯lu棒bang性xing也ye能neng夠gou增zeng強qiang。同tong時shi，為wei保bao護hu舵duo機ji不bu至zhi於yu向xiang左zuo向xiang右you打da得de太tai狠hen，可ke以yi限xian定ding舵duo機ji的de左zuo右you極ji限xian值zhi： 

 

通過調試參數A、B
、C，調節不同的Kp值
，實踐證明，小車能夠平穩

、快速的自動巡線前行。

 

6 結束語

 

該算法把舵機的轉向的Kp係數與車速相關起來，能夠很好地配合車速與舵機轉向，提出以具體的智能車參數分段PD參數的規律，對智能車實際製作很有幫助，在智能車比賽中具有很廣的推廣價值。

 

實踐證明，參數調節合適的時候智能車能夠很好的適應賽道
，跑出希望的 佳路徑。為了參加第五屆“飛思卡爾”杯全國大學生智能汽車競賽，此控製算法在校級代表隊資格選拔賽中表現完美
， 終跑出2．5 m／s的好成績，成功入選華北賽區參加比賽。實踐證明了智能車舵機分段PID控製轉向具有可行性和實用性。