基于閉環(huán)控制算法和PID優(yōu)化算法的智能小車(chē)軟件系統(tǒng)設(shè)計(jì)

《基于閉環(huán)控制算法和PID優(yōu)化算法的智能小車(chē)軟件系統(tǒng)設(shè)計(jì)》由會(huì)員分享，可在線閱讀，更多相關(guān)《基于閉環(huán)控制算法和PID優(yōu)化算法的智能小車(chē)軟件系統(tǒng)設(shè)計(jì)（8頁(yè)珍藏版）》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。

1、基于閉環(huán)控制算法和PID優(yōu)化算法的智能小車(chē)軟件系統(tǒng)設(shè)計(jì) 摘 要：在全國(guó)大學(xué)生"飛思卡爾";杯智能汽車(chē)競(jìng)賽的背景下，設(shè)計(jì)出一種能夠自動(dòng)識(shí)別路徑、跟蹤賽道雙邊引導(dǎo)線的智能小車(chē)軟件控制系統(tǒng)。智能小車(chē)以飛思卡爾(Freescale)公司的MC9S12XS128為檢測(cè)和控制核心，根據(jù)不同的環(huán)境狀況動(dòng)態(tài)確定黑白二值化閾值之后，對(duì)攝像頭采集到的圖像進(jìn)行處理，從而準(zhǔn)確判斷不同類型的賽道，進(jìn)一步控制舵機(jī)和電機(jī)。使用舵機(jī)轉(zhuǎn)向閉環(huán)控制算法和電機(jī)速度閉環(huán)控制算法，結(jié)合經(jīng)典的PID控制算法，實(shí)現(xiàn)直道加速、彎道減速的優(yōu)化。智能小車(chē)最終可以在黑色雙邊引導(dǎo)線的白色背景賽道上自動(dòng)識(shí)別路徑行駛。 關(guān)鍵詞：智能小車(chē)；M

2、C9S12XS128；圖像處理；閉環(huán)控制；PID控制 中圖分類號(hào)：TP311 文獻(xiàn)標(biāo)識(shí)碼：A Design of Smart Car Software System Based on Closed-Loop Control Algorithm and PID Optimization Algorithm LI Biyue (Dept . of Electronic Engineering,College of Information and Electrical Engineering ,China Agricultural University ,Beijing 10

3、0083,China ) Abstract:Under the background of "Freescale" cup national college students smart car competition,design a controlsystem software.Under this system,the smart car can automatically identify paths and trace the track of bilateral guideline.Tracking smart car system is designed based on

4、the control chip of system of Freescale MC9S12XS128 MCU.Afterdetermine the black and white binarization threshold according to the different environmental conditions,run a series ofprocessing on the images captured by the camera.Then,make an accurate judgment in the different shapes of the circuit t

5、ofurther control of steering gear and motor.Using steering gear steering closed-loop control algorithm and motor speed closedloopcontrol algorithm,combined with the classic PID control algorithm to achieve optimization of car was straight-lineacceleration,deceleration in bend.Smart car could eventua

6、lly automatically identify route which has the bilateral guide line ofthe white on black background and run steadily. Keywords:smart car;MC9S12XS128;image processing;closed-loop control;PID control 1 引言(Introduction) 智能車(chē)控制系統(tǒng)的設(shè)計(jì)以汽車(chē)電子為背景，涵蓋自動(dòng)控制、模式識(shí)別、傳感技術(shù)、計(jì)算機(jī)、機(jī)械與汽車(chē)工程等多門(mén)學(xué)科，是一項(xiàng)新興的綜合性技術(shù)。智能車(chē)系統(tǒng)是智能汽

7、車(chē)的迷你版本，二者在信息提取及處理、控制系統(tǒng)構(gòu)成和控制方案整定方面有諸多相似之處，可以說(shuō)智能車(chē)系統(tǒng)是智能汽車(chē)良好的實(shí)驗(yàn)平臺(tái)。 智能車(chē)系統(tǒng)主要包括三個(gè)大部分，分別為車(chē)?？傮w機(jī)械結(jié)構(gòu)、硬件電路系統(tǒng)、軟件算法控制系統(tǒng)。如果說(shuō)硬件是智能車(chē)行駛的基礎(chǔ)，那么程序算法就是靈魂。高效的程序則是智能車(chē)高速平穩(wěn)自動(dòng)尋跡的基礎(chǔ)。 2 系統(tǒng)總體設(shè)計(jì)(General design of system) 2.1 概述 智能小車(chē)控制系統(tǒng)采用飛思卡爾公司的16位單片機(jī)MC9S12XS128為檢測(cè)和控制核心【1】。以COMS數(shù)字?jǐn)z像頭OV7620為路徑檢測(cè)傳感器，以歐姆龍500線編碼器為速度檢測(cè)傳感器，

8、根據(jù)攝像頭檢測(cè)到的賽道信息【2】，以及編碼器采集到的小車(chē)速度信息，基于XS128單片機(jī)通過(guò)智能小車(chē)軟件控制系統(tǒng)對(duì)小車(chē)進(jìn)行舵機(jī)轉(zhuǎn)向和電機(jī)驅(qū)動(dòng)的控制，使智能車(chē)系統(tǒng)達(dá)到所需的穩(wěn)定性及快速性要求，從而實(shí)現(xiàn)小車(chē)的智能化行駛，如圖1所示。 2.1.1 需求規(guī)定 (1)在小車(chē)功能方面 最終完成的基于攝像頭傳感器的智能小車(chē)，要能夠做到在此軟件控制系統(tǒng)的支撐下，完成按規(guī)則繞賽道運(yùn)行一周的任務(wù)。在準(zhǔn)確識(shí)別賽道并穩(wěn)定運(yùn)行一周的基礎(chǔ)上【3】，期望小車(chē)的速度越快越好，即完成比賽的用時(shí)越短越好。 (2)在小車(chē)性能方面 第一，要求智能小車(chē)軟件控制系統(tǒng)應(yīng)具有良好的運(yùn)行效率，行駛速度盡可能

9、快，能夠快速準(zhǔn)確判斷出不同類型的彎道，并及時(shí)躲避在賽道上的障礙物；第二，應(yīng)具有良好的靈活性，使行駛速度、自身調(diào)整角度都可以靈活改變；第三，應(yīng)提供良好的測(cè)試模式，使設(shè)計(jì)人員可以方便的觀察、調(diào)整的小車(chē)運(yùn)行模式；第四，應(yīng)具有良好的可擴(kuò)展性，從而為日后升級(jí)系統(tǒng)提供方便。 2.1.2 運(yùn)行環(huán)境 2.2 系統(tǒng)各模塊設(shè)計(jì) 2.2.1 基于核心板MC9S12XS128的主程序(main函數(shù))設(shè)計(jì) (2)定義 PLL_Init( )：初始化鎖相環(huán)函數(shù)； SCI_Init( )：串口初始化函數(shù)； PIT_Init( )：PIT定時(shí)器中斷初始化函數(shù)；

10、PWM_Init( )：脈沖寬度調(diào)試模塊初始化函數(shù)； PH_Init( )：初始化單片機(jī)PH口函數(shù)(用于接收編碼器測(cè)速信息)； OV7620_Init( )：初始化攝像頭函數(shù)(用于OV7620信息采集)。 2.2.2 圖像采集模塊 (2)定義 存儲(chǔ)原始圖像矩陣的二維數(shù)組：Im a g e _ D a t a 。 (3)解釋 攝像頭是智能車(chē)的眼睛，我們將采用數(shù)字?jǐn)z像頭進(jìn)行賽道采集，在采集時(shí)，我們利用行、場(chǎng)中斷進(jìn)行數(shù)據(jù)采集。在每次捕捉到40個(gè)行中斷之后，觸發(fā)一次場(chǎng)中斷，其中，在行中斷的中斷子函數(shù)中利用單片機(jī)讀出圖像數(shù)據(jù)。由于單片機(jī)的處理能力有限，所

11、以不能對(duì)攝像頭的一場(chǎng)圖像中所有行的所有像素點(diǎn)都進(jìn)行處理，但為了獲得理想的賽道信息和足夠的前瞻量，需要通過(guò)多次實(shí)驗(yàn)，需要選擇出合適的行和每一行中需要采集的像素點(diǎn)數(shù)。最終，將所采集的數(shù)據(jù)存在一個(gè)二維數(shù)組中，得到原始的圖像矩陣，以便后續(xù)處理。 2.2.3 圖像處理模塊 (2)定義 BEST_THRESHOLD( )：確定最佳黑白二值化閾值函數(shù)。 (3)解釋 在圖像處理模塊，為了能夠做到識(shí)別不同光線環(huán)境下的賽道，首先需要確定一個(gè)合適的黑白二值化閾值，確定閾值后，在保持原始圖像矩陣大小不變的前提下，對(duì)其進(jìn)行均值濾波，在此算法基礎(chǔ)上對(duì)原始圖像進(jìn)行二值化處理，從而達(dá)到降

12、噪的目的，最終通過(guò)攝像頭的上位機(jī)獲取到賽道的二值圖像。 2.2.4 電機(jī)驅(qū)動(dòng)模塊 (1)電機(jī)驅(qū)動(dòng)模塊采取速度閉環(huán)控制原理，結(jié)構(gòu)示意圖如圖5所示。 (2)定義 speed_error=setV-backV：本次速度的偏差值=設(shè)定速度值-編碼器讀回的小車(chē)實(shí)際速度值； last_speed_error：上一次的速度偏差值； pre_speed_error：上上次的速度偏差值； derta_M：經(jīng)過(guò)PID控制器處理過(guò)后的速度改變量。 (3)解釋 取三次速度偏差值，經(jīng)過(guò)PID控制器的處理，得到處理后的速度改變量，作用在設(shè)定速度setV上，通過(guò)

13、調(diào)整過(guò)后的PWM波來(lái)控制電機(jī)的轉(zhuǎn)動(dòng)，使小車(chē)在不同類型賽道上行駛時(shí)有一個(gè)合適的速度。 2.2.5 舵機(jī)轉(zhuǎn)向模塊 (1)舵機(jī)轉(zhuǎn)向模塊采取運(yùn)動(dòng)方向閉環(huán)控制算法，結(jié)構(gòu)示意圖如圖6所示。 (2)定義 Error：原始偏差數(shù)組； angle_error=E2：本次角度的偏差值=處理后的偏差值E2； last_angle_error：上一次的角度偏差值； pre_angle_error：上上次的角度偏差值； derta_S經(jīng)過(guò)PID控制器處理過(guò)后的角度改變量。 (3)解釋 通過(guò)獲取到的賽道信息，提取出賽道的中線，與圖像的中線進(jìn)行比較，將每一

14、行的偏差值存儲(chǔ)在數(shù)組Error中，使用加權(quán)算法得到偏差值E2，取三次角度偏差值(指E2)，經(jīng)過(guò)PID控制器的處理，得到處理后的角度改變量，作用在舵機(jī)的參考零點(diǎn)上，通過(guò)調(diào)整過(guò)后的PWM波來(lái)控制舵機(jī)的轉(zhuǎn)向量。 2.2.6 調(diào)試模塊 為了能夠?qū)幋a器采集到的小車(chē)速度以及攝像頭采集到的賽道圖像進(jìn)行檢測(cè)，還需要完善調(diào)試檢測(cè)模塊。實(shí)際使用中，我們將成品藍(lán)牙模塊與USB-TTL模塊連接并連接至電腦，將另一個(gè)藍(lán)牙模塊連接至單片機(jī)的UART1組，即S2、S3口，該口定義為T(mén)XD、RXD，通過(guò)串口SCI接收與發(fā)送數(shù)據(jù)，接受到的數(shù)據(jù)我們通過(guò)上位機(jī)軟件，串口助手進(jìn)行接收。所接收到的圖像如圖7所示(以十字路

15、口的識(shí)別為例)。 3 關(guān)鍵技術(shù)及難點(diǎn)(Key technology and difficulty) 3.1 PID控制算法 3.1.1 PID控制算法簡(jiǎn)介 PID控制器是一種線性控制器，它根據(jù)給定值與實(shí)際輸出值構(gòu)成控制偏差。將偏差的比例(P)、積分(I)和微分(D)通過(guò)線性組合構(gòu)成控制量【4】，對(duì)被控對(duì)象進(jìn)行控制，故稱PID控制器，原理框圖如圖8所示。 3.1.2 增量式PID 可以看出由于一般計(jì)算機(jī)控制系統(tǒng)采用恒定的采樣周期T，一旦確定了KP、KI、KD，只要使用前后三次量值的偏差，即可由上式求出控制增量【5】。 3.

16、2 圖像采集時(shí)如何躲避消隱區(qū) 在攝像頭進(jìn)行圖像信息采集時(shí)會(huì)產(chǎn)生消隱區(qū)失真的問(wèn)題，故使用延時(shí)函數(shù)，通過(guò)延時(shí)作用來(lái)跳過(guò)圖像采集時(shí)的消隱信號(hào)，保證圖像不失真。 3.3 黑白二值化閾值的確定 要想從原始圖像數(shù)組中分離出白色賽道、黑色邊界和藍(lán)色的底布，必須在程序上設(shè)置一個(gè)灰度的閾值，當(dāng)像素點(diǎn)灰度值大于該閾值時(shí)為白色賽道，當(dāng)像素點(diǎn)灰度值小于該閾值時(shí)為非賽道，所以要將此值設(shè)置在藍(lán)色底布和白色賽道之間。但是由于比賽場(chǎng)地?zé)艄?，以及底布藍(lán)色深淺的不同，所界定的閾值也應(yīng)該相應(yīng)的改變，所以采用動(dòng)態(tài)閾值可以大大提高小車(chē)對(duì)比賽環(huán)境的適應(yīng)性【6】。 3.4 圖像降噪時(shí)的均值濾波算法

17、 點(diǎn)在內(nèi)的像素總個(gè)數(shù)。 在具體實(shí)現(xiàn)過(guò)程中，我們將在原始圖像矩陣中依次取3*3的矩陣，采用九宮格形式，將每一次計(jì)算的均值賦給該矩陣的左上角元素，得到處理過(guò)后圖像矩陣，根據(jù)動(dòng)態(tài)設(shè)定的閾值進(jìn)行二值化操作，得到最終的賽道的二值圖像。 3.5 電機(jī)驅(qū)動(dòng)模塊Set_V的確定 由于在不同類型的賽道上小車(chē)行駛的速度不同，故設(shè)定值Set_V不能始終為一個(gè)固定值參與到電機(jī)控制環(huán)中。 3.6 賽道中線的提取 前提：規(guī)定白色為1，黑色為0。具體操作：提取二值化賽道圖像(圖10)的一行，從該行數(shù)組的第一個(gè)元素開(kāi)始判斷，當(dāng)連續(xù)的1達(dá)到一定個(gè)數(shù)時(shí)(暫時(shí)規(guī)定10個(gè)1為標(biāo)準(zhǔn))，則第一個(gè)

18、檢測(cè)到的1所在的位置確定為L(zhǎng)eft；從該行數(shù)組的最后一個(gè)元素開(kāi)始倒序判斷，同樣，當(dāng)連續(xù)的1達(dá)到一定個(gè)數(shù)時(shí)，第一個(gè)檢測(cè)到的1所在的位置確定為Right，每行數(shù)組均進(jìn)行此操 3.7 對(duì)原始偏差數(shù)組的加權(quán)處理算法 小車(chē)速度大小V對(duì)圖像遠(yuǎn)近處偏差值權(quán)重大小的影響：車(chē)速慢時(shí)舵機(jī)不用提前打角，只需利用近處的圖像便可跑好，但是車(chē)速快時(shí)，由于舵機(jī)要提前打角，所以即使遠(yuǎn)處的圖像不夠真實(shí)準(zhǔn)確，對(duì)于快速行駛的小車(chē)來(lái)說(shuō)遠(yuǎn)處的圖像也顯得很重要。 因此，當(dāng)獲取到原始偏差數(shù)組Error后，需要通過(guò)加權(quán)處理，對(duì)數(shù)組中不同行的元素乘以不同的權(quán)值，最終得到較為準(zhǔn)確的偏差量E 2，該權(quán)值分配需滿足如圖11

19、所示的關(guān)系。 4 結(jié)論(Conclusion) 經(jīng)過(guò)調(diào)試和檢測(cè)的結(jié)果證明，在基于MC9S12XS128的智能車(chē)軟件控制系統(tǒng)的作用下，小車(chē)能夠在黑色雙邊引導(dǎo)線的白色背景賽道上自動(dòng)識(shí)別路徑平穩(wěn)行駛。通過(guò)PID控制算法的優(yōu)化，實(shí)現(xiàn)了直道加速、彎道減速的設(shè)想；在圖像采集時(shí)，使用延時(shí)函數(shù)在一定程度上解決了圖像消隱區(qū)失真問(wèn)題；均值濾波的降噪處理對(duì)于采集到的圖像進(jìn)行了進(jìn)一步的完善；閉環(huán)控制算法更是保證了小車(chē)行駛的穩(wěn)定性和快速性。相信通過(guò)進(jìn)一步的探索與完善，這個(gè)智能小車(chē)軟件控制系統(tǒng)會(huì)得到越來(lái)越廣泛的應(yīng)用。 參考文獻(xiàn)(References) 【1】 Zhang.L.,Q.H.So

20、ng.Design of Smart Car ServosystemB a s e d o n C a m e r a . M a n u f a c t u r i n g S c i e n c e a n dTechnology,2012:5923-5927. 【2】 Jiang.Z.J.,M.F.Wang,P.Guo.The Road Information VideoCapture and Processing Research for Smart Car Basedon CMOS Camera.Proceedings of 2009 InternationalConfere

21、nce on Information,Electronic and ComputerScience,Vols I and II,2009:96-101. 【3】 Ye.M.J.,C.H.Hu.Design of Electromagnetic Smart CarS y s t e m . M e c h a n i c a l a n d E l e c t r o n i c s E n g i n e e r i n gIII,2012:343-346. 【4】 張飛飛,楊雪松.基于MC9S12XS128單片機(jī)的路徑圖像識(shí)別智能小車(chē).甘肅科技,2013(13):12-14. 【5】 陶永華.新型PID控制及其應(yīng)用──第一講PID控制原理和自整定策略.工業(yè)儀表與自動(dòng)化裝置,1997(04):60-64;46. 【6】 孔巖,董奧,王勇.攝像頭型智能車(chē)的賽道類型處理.電子世界,2016(11):134. 【7】 王惠華,等.基于二值圖像連通域提取的圖像濾波方法.北京印刷學(xué)院學(xué)報(bào),2015,06:39-41. 李旭東,廖中浩,孟嬌.基于CMOS攝像頭的智能車(chē)控制系統(tǒng)設(shè)計(jì)及實(shí)現(xiàn).吉林大學(xué)學(xué)報(bào)(信息科學(xué)版),2013(04):414-418. 作者簡(jiǎn)介： 李碧月(1996-)，女，本科生.研究領(lǐng)域：電子信息工程.