基于自動控制理論的高速循跡智能車設(shè)計

林志強(qiáng)，萬在紅

（南昌航空大學(xué) 信息工程學(xué)院，江西 南昌 330063）

基于自動控制理論的高速循跡智能車設(shè)計

林志強(qiáng)，萬在紅

（南昌航空大學(xué) 信息工程學(xué)院，江西 南昌 330063）

本設(shè)計以自動控制系統(tǒng)為研究對象，以飛思卡爾K60單片機(jī)為控制核心，設(shè)計了一種新型智能高速循跡小車，旨在解決現(xiàn)實生活中勘測、搜救行動中人為難以到達(dá)位置的勘探搜救難題。基于自動控制理論的智能高速巡跡小車，利用各類傳感器確定路徑及姿態(tài)，實現(xiàn)智能高速循跡行駛，具有自動穩(wěn)定控制車身，高速行駛，并穩(wěn)定回傳數(shù)據(jù)的功能，使現(xiàn)實生活中的搜救勘探活動更加智能高效。

自動控制系統(tǒng)；智能車；pid控制；自動

智能循跡小車作為智能行走機(jī)器人的一種，其采用傳統(tǒng)的四輪行走的機(jī)械結(jié)構(gòu)，具有適應(yīng)多種環(huán)境、抗干擾性強(qiáng)、成本低、安全性高的優(yōu)點，可代替人進(jìn)入各種復(fù)雜的環(huán)境開展各種勘探測量工作［1］。本設(shè)計將電路設(shè)計技術(shù)、傳感器技術(shù)、自動控制理論等技術(shù)知識，綜合設(shè)計出自動循跡行駛的高速智能小車。本設(shè)計具有較強(qiáng)的科學(xué)先進(jìn)性，該小車配備光電傳感器，可自動識別路徑上存在的黑線。配備的加速度計可監(jiān)控小車車身的偏移及各方向的加速度。再配以編碼器模塊，實時得到小車運行速度。最后通過算法綜合各種得到的數(shù)據(jù)，運用自動控制理論實現(xiàn)小車的自動循跡形式。本設(shè)計還配有無線傳輸模塊，以實現(xiàn)小車狀態(tài)的實時回傳［2］。

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

1.1系統(tǒng)硬件設(shè)計總體框架

系統(tǒng)硬件包括：單片機(jī)控制系統(tǒng)，采用飛思卡爾k60單片機(jī)，傳感器檢測系統(tǒng)，包括光電傳感器，mpu60506軸加速度計，編碼器模塊，電機(jī)驅(qū)動模塊，無線傳輸模塊。系統(tǒng)整體框圖如圖1所示。

圖1　硬件系統(tǒng)總體框架

1.2傳感器檢測系統(tǒng)

1.2.1線性CCD光電傳感器

該模塊內(nèi)置TSL1401CL線性傳感器，TSL1401CL線性傳感器由128×1列光電二極管，內(nèi)部集成了電荷放大器電路，以及像素數(shù)據(jù)保持功能，可同時集成啟動和停止所有像素位［3］。該陣列由128個像素構(gòu)成， 每個像素點都有一個3 524.3 μm2的光敏區(qū)域。像素之間有8μm間距。內(nèi)部控制邏輯簡化了芯片操作，只需要一個串行輸入（SI）信號和一個時鐘信號（Clock）就可以完成全部邏輯控制，讀取AO口的電壓就可以完成數(shù)據(jù)采集。在檢測到黑線的時候相應(yīng)點返回較低電壓，白色時返回較高電壓。通過單片機(jī)adc口讀取128個電壓值，可判斷出路徑上一條橫向線段的情況，如圖2所示。本設(shè)計采用3個線性ccd，可獲取3行圖像，融合數(shù)據(jù)后可判斷出前方道路信息，以實現(xiàn)巡跡［4］。

圖2　線性ccd道路采集上位機(jī)顯示數(shù)據(jù)

1.2.2mpu6050六軸加速度計

mpu6050為三軸陀螺儀三軸加速度計模塊，其外觀如圖3所示，其可輸出小車在運行過程中三軸上的加速度和角加速度，對其積分，即可得到小車的角加速度和角速度。其還帶有硬件dmp結(jié)算能力，即內(nèi)部的運動引擎，直接輸出四元數(shù)［5］，可以減輕外圍微處理器的工作負(fù)擔(dān)且避免了繁瑣的濾波和數(shù)據(jù)融合過程，設(shè)計中可選擇硬件解算和軟件解算兩種方式。

若使用軟件解算，其角度計算公式為：angle_n=angle_ n-1+（Gyro-C_Gyro）*R_Gryo; angle_n為當(dāng)前角度值，angle_n-1為上一次計算的角度值，Gyro為陀螺儀敏感軸偏轉(zhuǎn)值，C_Gyro陀螺儀零點偏移值，R_Gyro是陀螺儀比例［6］。通過計算出角度，可以判斷出小車運行平地、坡道等狀態(tài)，因而已實現(xiàn)對小車的不同控制。

圖3　mpu6050模塊

1.2.3編碼器模塊

光電軸角編碼器是一種具有代表性的角位移傳感器，是一種集光、機(jī)、電于一體的數(shù)字測角裝置［7］。該模塊為512線光電增量式編碼器，其用光信號掃描分度盤（分度盤與轉(zhuǎn)動軸相連），其內(nèi)部置有一個512線的光柵，隨輪胎轉(zhuǎn)動軸轉(zhuǎn)動，當(dāng)轉(zhuǎn)動到分度盤的光縫剛好使光照射到接收管時，編碼器會輸出一個信號脈沖。將其連接到單片機(jī)PWM捕獲口，利用單片機(jī)自帶的正交解碼功能，可以檢測、統(tǒng)計信號的通斷數(shù)量，由此計算出車輪的正反轉(zhuǎn)向及旋轉(zhuǎn)角度，從而得到小車的運行速度。

1.2.4電機(jī)驅(qū)動模塊

如圖4所示，該電路由脈寬調(diào)制電動機(jī)控制芯片HIP4802 4 個mos管搭建的H橋組成，單片機(jī)輸入PWM脈沖，由HIP4802控制H橋電路的通斷時間。直流電機(jī)驅(qū)動使用最廣泛的是H型傘橋式電路，這種驅(qū)動電路能方便地實現(xiàn)電機(jī)的四象限運行，即正轉(zhuǎn)、正轉(zhuǎn)制動、反轉(zhuǎn)、反轉(zhuǎn)制動［8］。當(dāng)一定時間內(nèi)電路導(dǎo)通時間占比大時，電機(jī)轉(zhuǎn)動就快。當(dāng)導(dǎo)通時間占比小時，電機(jī)轉(zhuǎn)動就慢。電路不導(dǎo)通時電機(jī)停止轉(zhuǎn)動。4個mos管相當(dāng)于4個開關(guān)，當(dāng)Q2和Q3導(dǎo)通時，電機(jī)正向轉(zhuǎn)動［9］。當(dāng)Q1和Q4導(dǎo)通時，電機(jī)反向轉(zhuǎn)動。場效應(yīng)管為壓控元件，輸入阻抗大，開關(guān)速度快，且可承受大電流通過，滿足小車的高速行駛控制的性能要求。

圖4　電機(jī)驅(qū)動電路

1.2.5無線傳輸模塊

無線傳輸模塊采用目前通信采用最廣泛的2.4 G通訊技術(shù)，其采用nrf24l01無線通訊芯片，其電路如圖5所示，配以較大功率天線，其傳輸距離可達(dá)100 m以上［10］。其可被單片機(jī)配置為接受或發(fā)送模式，還可以配置頻道、地址、每次發(fā)送的字節(jié)數(shù)、是否帶CRC校驗、功率等。具有多通道抗干擾傳輸?shù)膬?yōu)點，可實現(xiàn)一對六多向通訊，高效且穩(wěn)定。

圖5　無線傳輸模塊電路

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

2.1軟件系統(tǒng)設(shè)計整體框架

本程序采用定時中斷控制系統(tǒng)，每隔10 ms進(jìn)行一次數(shù)據(jù)采集，每隔5 ms進(jìn)行姿態(tài)調(diào)整，確保車身控制的穩(wěn)定性和及時性。軟件設(shè)計總體框架如圖6所示。

圖6　軟件設(shè)計總體框圖

2.2算法設(shè)計

2.2.1pid控制算法

pid控制器是自動控制理論中最重要的控制器之一。其運用偏差量的比例（p）、積分（I）和微分（d）進(jìn)行控制。在實際運用中，發(fā)現(xiàn)對舵機(jī)的控制采用位置式pd控制的效果最好，而對電機(jī)控制采用增量式pid效果最好［11］。

位置式pid理想算式為：

其輸出量即為控制量，可直接用于舵機(jī)的控制輸出。式中：

u（t）—控制器（也稱調(diào)節(jié)器）的輸出；

e（t）—控制器的輸入（常常是設(shè)定值與被控量之差，即e（t）=r（t）-c（t）；

Kp—控制器的比例放大系數(shù)；

Ti—控制器的積分時間；

Td—控制器的微分時間。

其算法為：

而增量式pid的輸出只是控制量的增量，需要對控制量增量累加后對電機(jī)輸出控制［12］，其算法如下：

2.2.2動態(tài)P控制算法

在實際pid控制運用中，為實現(xiàn)小車適應(yīng)各種環(huán)境，保證車身穩(wěn)定，固定pid值的pid算法效果，在實際Matlab仿真后，發(fā)現(xiàn)將小車舵機(jī)控制所用的p值（pid控制中的比例值）與計算出的車身與路徑的偏移量擬合成一條二次曲線后，舵機(jī)打角及時，過彎流暢，可實現(xiàn)高速過彎［13］。其實現(xiàn)代碼如下：

pp-＞Proportion ＝ a*Err*Err+b*Err+c。

實際調(diào)試中，根據(jù)所面臨的環(huán)境，理論計算出實際所需的二次曲線。在MATLAB中，調(diào)整a，b，c 3值使所得曲線近似擬合為所需要的實際曲線即可。

2.3路徑識別算法

在路徑識別上，本設(shè)計采用二值化處理圖像，用基于閾值的中值濾波算法通過設(shè)定閾值，判斷像素是否為噪點，如果是噪點，可通過中值濾波消除其影響［14］。然后對圖像進(jìn)行二值化，使圖像只具有黑白兩變量。最后通過逐點查找數(shù)據(jù)跳變沿確定道路邊緣。左右邊緣確定后即可通過求中值確定智能車位置。將其偏移量導(dǎo)入舵機(jī)和電機(jī)pid計算實現(xiàn)小車的方向和速度控制［15］。

3　結(jié)語

該設(shè)計采用單片機(jī)控制搭載傳感控制電路為硬件平臺，結(jié)合自動控制理論綜合設(shè)計算法，極大地提高智能車的自適應(yīng)能力。經(jīng)實際運用測試，該小車能在多種環(huán)境下高速機(jī)動行駛，具有穩(wěn)定可靠的功能，達(dá)到設(shè)計目標(biāo)。

[1]楊會成，費琛，王筱薇倩，等.基于單目視覺的智能尋跡小車設(shè)計與實現(xiàn)[J].重慶理工大學(xué)學(xué)報（自然科學(xué)版），2013（3）：441-455.

[2]師樹恒，孫明，師素娟.基于MC9S12XS28的智能循跡小車設(shè)計[J].自動化與儀表，2012（4）：50-60.

[3]駱文博，王廣志，丁海曙，等.基于線陣 CCD的高精度位置檢測[J].清華大學(xué)學(xué)報（自然科學(xué)版），2002（9）：1139-1143.

[4]李晶，袁峰，丁振良.基于Rodrigues參數(shù)的多線陣CCD外姿態(tài)測量系統(tǒng)的姿態(tài)解算[J].光學(xué)精密工程，2012（4）：858-864.

[5]王顯軍.光電軸角編碼器細(xì)分信號誤差及精度分析[J].光學(xué)精密工程，2012（2）：379-386.

[6]胡發(fā)煥，邱小童，蔡咸健.基于場效應(yīng)管的大功率直流電機(jī)驅(qū)動電路設(shè)計[J].電機(jī)與控制應(yīng)用，2011（4）：21-25.

[7]張榮輝，賈宏光，陳濤，等.基于四元數(shù)法的捷聯(lián)式慣性導(dǎo)航系統(tǒng)的姿態(tài)解算[J].光學(xué)精密工程，2008（10）：1963-1971.

[8]丁明理，王祁，宋凱.無陀螺慣性測量組合姿態(tài)解算新方法[J].哈爾濱工業(yè)大學(xué)學(xué)報，2006（7）：1025-1028.

[9]劉玉兵，張俞，吳江源.2.4 G無線文件傳輸系統(tǒng)的設(shè)計與實現(xiàn)[J].中國集成電路，2012（3）：77-81.

[10]余曉填，楊曦，陳安，等.基于移動機(jī)器人直流電機(jī)驅(qū)動電路的設(shè)計與應(yīng)用[J].微電機(jī)，2011（11）：37-41.

[11]仇成群，劉成林，沈法華，等.基于Matlab和模糊PID的汽車巡航控制系統(tǒng)設(shè)計[J].農(nóng)業(yè)工程學(xué)報，2012（6）：197-203.

[12]羅天資，陳衛(wèi)兵，鄒豪杰.直線電機(jī)模糊增量PID控制算法的研究[J].測控技術(shù)，2011（2）：56-60.

[13]王志堅，張鳳登.基于CAN總線的分布式動態(tài)PID算法實現(xiàn)[J].信息技術(shù)，2015（4）：181-185

[14]李 進(jìn)，陳無畏，李碧春，等.自動導(dǎo)引車視覺導(dǎo)航的路徑識別和跟蹤控制[J].農(nóng)業(yè)機(jī)械學(xué)報，2008（2）：20-24.

[15]季聰，王思明，漢鵬武.智能車路徑識別與控制研究[J].電視技術(shù)，2013（9）：192-209.

Design of high speed intelligent car based on automatic control theroy

Lin Zhiqiang, Wan Zaihong
（Information Engineering College of Nanchang Hangkong University, Nanchang 330063, China）

In order to resolve the difficulty in some place where human is hard to reach in search and rescue activities, this design designed a new type high-speed smart car, which used the free scale K60 micro controller as the control core, choosing the automatic control system as the research object. Based on the theory of automatic control, the intelligent high speed tracking car used all kinds of sensor to determine the path and posture, to achieve the requirement of driving high-speed and automatically. The design has advantage of intelligent, high speed tracking and automatic stabilization control body, and with the function of the stability of return data, it makes search and rescue exploration activities in reality more intelligent and efficient.

automatic control system; intelligent car; pid control; automatic

林志強(qiáng)（1995— ），男，江西贛州，本科；研究方向：電子信息技術(shù)，自動控制技術(shù)。