【正文】 參賽車“途銳”取得了冠軍。整個賽道有急轉(zhuǎn)彎、隧道、路口還有山路，比賽要求參賽車輛能夠自主完成全部路程。在軍事用途方面，早在80年代初期，美國國防部就大規(guī)模資助自主陸地車輛ALV （Autonomous LandVehicle)的研究。 and according to the characteristics of the smart car system, the digital PID algorithm is improved, the proportion parameter method is automatically adjusted, to improve the dynamic characteristics of the system。軟件系統(tǒng)部分主要包括與路徑識別系統(tǒng)相關(guān)模塊的算法。本智能小車以飛思卡爾公司的16位單片機MC9S12XS128B為核心控制器，利用CMOS視頻傳感器采集路況信息，配合速度傳感器、電機、舵機、電池等組成的電路進行信息處理，以達到路徑識別的目的，控制模型車高速穩(wěn)定地在跑道上行駛。智能小車系統(tǒng)是一個時變且非線性的系統(tǒng)，采用傳統(tǒng)PID算法的單一的反饋控制會使系統(tǒng)存在不同程度的超調(diào)和振蕩現(xiàn)象，無法得到理想的控制效果。利用開發(fā)工具CodeWarrior進行編程開發(fā)，用BDM進行程序下載，利用串口傳輸?shù)臄?shù)據(jù)進行在線調(diào)試。 at the same time in this paper, the bangbang algorithm bined with PID algorithm, can effectively improve the adaptability and robustness of the smart car, improve the performance of the control system.The hardware includes, fullbridge motor is built with a halfbridge BTS7970B chip drive circuit, using TPS7350 and LM1117 as stabilizing circuit core chip and posed of E6A2CS3C encoder speed software system includes the path recognition module algorithm. This system makes use of the development tools of CodeWarrior programming, to download program with BDM, the online debugging using the serial transmission of data. The system achieves the basic path identification function, in the actual test, the car is good to plete inspection driving task.Key words: smart car control system PID algorithm running on the runway目 錄1 前言 1 課題的目的和意義 1 國內(nèi)外研究現(xiàn)狀 1 國外研究現(xiàn)狀 1 國內(nèi)研究現(xiàn)狀 32 智能小車控制系統(tǒng)方案的設(shè)計與實現(xiàn) 4 4 6 8 離散式PID控制方法 8 模糊控制方法 9 賽道記憶方式 93 控制算法仿真與開發(fā)環(huán)境 10 主控芯片MC9S12XS128簡介 10 最小系統(tǒng)板簡介 11 功能模塊簡介 12 開發(fā)軟件簡介 13 BDM調(diào)試器的使用 13 Hiwave初始化參數(shù)設(shè)置 13 程序下載 15 程序調(diào)試 174 功能模塊的設(shè)計原理與流程圖 17 路徑識別模塊 18 PID控制算法介紹 19 位置式PID控制算法 20 增量式PID控制算法 21 PID參數(shù)整定 21 舵機轉(zhuǎn)向控制 22 速度的閉環(huán)控制 23 閉環(huán)速度控制 23 驅(qū)動電機的PID控制算法 23 剎車功能的實現(xiàn) 245 電機驅(qū)動模塊與速度反饋模塊 25 電機驅(qū)動模塊方案的對比與選擇 25 MOSFET組成的半橋驅(qū)動 25 MOSFET組成的全橋驅(qū)動 26 BTS7970B組成的全橋驅(qū)動 26 電機驅(qū)動模塊的詳細設(shè)計 27 電機驅(qū)動芯片BT7970B簡介 27 隔離芯片74LS244B簡介 28 基于BTS7970B的電機驅(qū)動模塊 29 速度檢測模塊方案的對比與選擇 30 速度檢測模塊的詳細設(shè)計 31 歐姆龍E6A2編碼盤簡介 31 編碼盤的安裝和使用方式 326 模塊調(diào)試及開發(fā)軟件的使用與調(diào)試 33 模塊調(diào)試 33 PWM模塊調(diào)試 33 無線模塊調(diào)試 34 總體調(diào)試 35 開發(fā)軟件的使用與調(diào)試 35 開發(fā)軟件的使用 35 調(diào)試過程 357 總結(jié) 36參 考 文 獻 37附 錄 38致 謝 46 畢業(yè)設(shè)計成績評定表I1 前言 課題的目的和意義本課題的是基于全國大學(xué)生飛思卡爾智能車競賽的背景，該競賽是教育部舉辦的五大賽事之一，其主要目的是加強大學(xué)生實踐、創(chuàng)新能力和團隊精神的培養(yǎng)。進入21世紀，為促進無人駕駛車輛的研發(fā)，美國國防部高級研究項目局(DARPA) 從2004年起開始舉辦機器車挑戰(zhàn)大賽(Grand Challenge)。最終斯坦福大學(xué)的“斯坦利”，獲得了第1名。該車通過影像處理尋找道路，周圍景物被處理成3D影像。隨著賽事的逐年開展，將不僅有助于大學(xué)生自主創(chuàng)新能力的提高，對于高校相關(guān)學(xué)科領(lǐng)域?qū)W術(shù)水平的提升也有一定幫助，最終將有助于汽車企業(yè)的自主創(chuàng)新，得到企業(yè)的認可。德國寶馬公司也提供了不菲的資助，邀請3名獲獎學(xué)生到德國寶馬公司研究所訪問，2005年SUNMOON大學(xué)的參賽者獲得了這一殊榮，圖3為他們設(shè)計的智能車模型（黃開勝，金華民，蔣狄南，2006）。 此次大賽由作為全球最大汽車電子半導(dǎo)體供應(yīng)商的飛思卡爾半導(dǎo)體全程贊助。所以要先對智能小車的模型和控制算法進行正確分析設(shè)計（張鵬，徐怡，任亞楠，2008）。不論是傳感器部分數(shù)據(jù)的錯誤采集和識別，還是轉(zhuǎn)向伺服電機控制的失當(dāng)，都會造成模型車嚴重抖動甚至偏離賽道；如果直流電機的驅(qū)動控制效果不好，還會造成直線路段速度上不去，或彎曲路段入彎速度過快而使智能車沖出賽道等問題（張建強，莊可佳，方程，2009；孫嘉，孫凱，周璐，2010）。該單片機功能強大，完全能夠勝任小車的檢測和控制功能。(5)電機驅(qū)動模塊通過電機驅(qū)動模塊，控制驅(qū)動電機兩端電壓可以使模型車加速運行，也對模型車進行制動。智能車系統(tǒng)根據(jù)檢測到的路況和車速的當(dāng)前信息，控制轉(zhuǎn)向舵機和直流驅(qū)動電機，相應(yīng)地調(diào)整小車的行駛方向和速度；最終的目的是使智能車能快速、穩(wěn)定地按給定的黑色引導(dǎo)線行駛（卓晴，黃開生，邵貝貝，2007）。因此，對智能車的設(shè)計，要求具有實時路徑檢測功能和良好的調(diào)速功能。采用加長轉(zhuǎn)臂的舵機及合理的路徑搜索算法，可以增強智能車對軌跡的跟隨性能?？刂颇Ｐ蛙嚨霓D(zhuǎn)向和速度，使其能夠跟隨道路的變化來運行。在設(shè)計控制算法時，要既能滿足跟隨系統(tǒng)的動態(tài)特性，同時又能滿足恒值調(diào)節(jié)的穩(wěn)定特性。 ()其中：d(l)是模型車與道路中心線的偏移量；k是系數(shù)；A(τ)為舵機輸出轉(zhuǎn)角；X為前輪轉(zhuǎn)向角度改變量與舵機輸出角度改變量之比。通過上述分析可知僅僅控制模型車以最快的速度運行是不可以的。依靠簡化的模型，盡量采用軟件方法來解決復(fù)雜的硬件電路部分，使系統(tǒng)硬件簡潔化，各類功能易于實現(xiàn)，滿足各項的要求。該算法實際是一個非線性控制器，它是根據(jù)偏差，將偏差按比例，積分和微分通過線性組合構(gòu)成控制量，對被控對象進行控制。積分作用可以消除靜差，但積分器可使動態(tài)響應(yīng)變慢，這對于對實時性要求非常高的小車控制系統(tǒng)來說不適合使用，因此本文沒有使用積分控制，將PID控制簡化為PD控制。它的控制規(guī)律是以前人的經(jīng)驗總結(jié)出來的條件語句表示，容易設(shè)計掌握，對于被控對象的參數(shù)變化有很強的魯棒性。路徑記憶算法的優(yōu)勢在于對于復(fù)雜的S彎道，可以實現(xiàn)類似CCD探測頭達到的效果，選用小的轉(zhuǎn)向角度通過，這樣可以大大縮短時間。所以最終決定用PID算法，并且本文在PID算法中加入了bangbang算法，使得該算法的魯棒性更好，性能更佳。該軟件是面向以HC12或S12為CPU的單片機嵌入式應(yīng)用開發(fā)軟件包。HC12核心是16位高速CPU12核，總線速度8MHZ；HCS12系列單片機以速度更快的CPU12內(nèi)核為核心，簡稱S12系列，典型的S12總線速度可以達到25MHZ（清華大學(xué)Freescale MCU/DSP應(yīng)用開發(fā)研究中心，2010）。MC9S12XS128就是S12X系列中的一個成員。MC9S12XS128的脈寬調(diào)制模塊(PWM)可設(shè)置成4路8位或者2路16位，邏輯時鐘選擇頻率。 S12 CPU128KB FLASH2個8路10位ADC增強型8路16位定時器8位8路/16位4路PWM2個SCI口3個SPI口I2CJ1850通信口最多5個增強型CAN總線接口12KB RAM4KB EEPROM16位鍵盤喚醒IRQ I/O口圖10 MC9S12XS128B單片機結(jié)構(gòu)組成 最小系統(tǒng)板簡介以MC9S12XS128芯片為核心的最小系統(tǒng)主要包括以下幾部分：時鐘電路、BDM接口、供電電路、復(fù)位電路和調(diào)試用LED燈。標準的MC9S12XS128單片機的時鐘電路，通過把一個16HZ的外部晶振接到單片機的外部晶振輸入接口EXTAL和XTAL上，讓后利用MC9S12XS128內(nèi)部的壓控振蕩器(VCO)和鎖相環(huán)(PLL)把這個頻率提高到25HZ，使之作為單片機工作的內(nèi)部總線時鐘。(3)電源電路HCS12單片機的芯片內(nèi)部使用3V電壓，而I/O端口和外部供電電壓為5V。通常使用低電壓復(fù)位芯片MC34064，使上電復(fù)位更加可靠。每個輸出通道都有一個精確的計數(shù)器、一個周期控制寄存器和兩個可供選擇的時鐘源。在要求精度不高的情況下，PWM波可以用作D/A轉(zhuǎn)換，最簡單的方法就是在PWM輸出口加入一個低通濾波，可以將PWM波轉(zhuǎn)換成相應(yīng)的模擬量。PWM信號的周期大于某一閾值后可驅(qū)動舵機工作，保持周期、調(diào)節(jié)PWM的占空比即可調(diào)節(jié)舵機的轉(zhuǎn)動方向。在CodeWarrior 軟件中可以使用匯編語言或C 語言，以及兩種語言的混合模式。圖12 程序啟動界面(2)安裝BDM for S12(TBDML)的驅(qū)動程序。(3)選擇BDM接口標準，如圖14所示，【Component】菜單中【Set Target…】選項。如圖15所示。復(fù)位可以通過選擇TBDML HCS12|Reset菜單命令或者單擊工具欄的快捷圖標來實現(xiàn)?，F(xiàn)對其各窗口功能作簡單介紹如下。在對攝像頭的調(diào)試中，能查看所有采集點的對應(yīng)數(shù)值，從而找出對應(yīng)的黑線位置。 Command：命令行，具體的命令可以鍵入help查看。系統(tǒng)初始化檢測道路信息計算智能車位置智能車速度控制智能車方向控制輸出開始圖19 程序框圖中斷開始 保護現(xiàn)場采樣濾波是否有效？儲存數(shù)據(jù)重置標志位恢復(fù)現(xiàn)場中斷返回否是圖20 定時器采樣中斷 路徑識別模塊由于本文側(cè)重于直流電機和舵機的控制系統(tǒng)，所以對于路徑識別模塊就做簡單的介紹，使用的是CMOS動態(tài)攝像頭OV5116。該模塊的功能是準確的計算出黑線與小車中心的相對位置。第二次開始搜索時，就不全掃描了，在上一行的兩個基點位置，對本行的黑線進行搜索，往外搜3個點(搜索范圍越小，抗干擾性越高，但容易丟失，所以搜索范圍要適當(dāng))。PID 控制器問世至今已有近 70 年歷史，它以其結(jié)構(gòu)簡單、穩(wěn)定性好、工作可靠、調(diào)整方便而成為工業(yè)控制的主要技術(shù)之一。PID 控制器是一種線性控制器，它根據(jù)給定值與實際輸出值構(gòu)成控制偏差。積分環(huán)節(jié)：主要用于消除靜差，提高系統(tǒng)的無差度。 位置式PID控制算法位置式 PID 中，由于計算機輸出的 u (k) 直接去控制執(zhí)行機構(gòu)(如閥門)，u(k)的值和執(zhí)行機構(gòu)的位置(如閥門開度)是一一對應(yīng)的，所以通常稱公式()為位置式 PID 控制算法。 (2)手動/自動切換時沖擊小，便于實現(xiàn)無擾動切換。但增量式 PID 也有其不足之處：積分截斷效應(yīng)大，有靜態(tài)誤差；溢出的影響大。它主要是依據(jù)系統(tǒng)的數(shù)學(xué)模型，經(jīng)過理論計算確定控制器參數(shù)；二是工程整定方法，它主要依賴工程經(jīng)驗，直接在控制系統(tǒng)的試驗中進行，且方法簡單、易于掌握，在工程實際中被廣泛采用。所以本文對P參數(shù)進行了非線性處理，即非線性PD控制算法，其策略如下：(1) 將積分項系數(shù)置零，相比穩(wěn)定性和精確性，舵機在這種隨動系統(tǒng)中對動態(tài)響應(yīng)性能的要求更高。（孫同景，2008）由于硬件上安裝了車速傳感