學 校：大連理工大學?
隊伍名稱：銀龍隊????
參賽隊員：朱煬爽????
郁東輝????
張婧宜????
帶隊教師：吳振宇 李勝銘?

引 ? 言

??隨著電子科技的不斷發(fā)展，越來越多的自動化設備開始進入到人們的生產生活中，嵌入式的迅猛發(fā)展為智能研究提供了更廣闊的平臺。在工業(yè)生產、科學探索、救災搶險、軍事等方面，人工智能發(fā)揮著越來越重要的作用，在此背景下，智能控制策略變得尤為重要。

??全國大學生杯智能汽車競賽是國家教學質量與教學改革工程資助項目，以恩智浦半導體公司生產的16、32位單片機為核心控制模塊，通過增加道路傳感器、電機驅動電路以及編寫相應程序，制作一個能夠自主識別道路的汽車模型。因而該競賽是涵蓋了智能控制、模式識別、傳感技術、汽車電子、電氣、計算機、機械等多個學科的比賽，對學生的知識融合和實踐能力的提高，具有良好的推動作用。

??本文采用第十六屆全國大學生智能車競賽的汽車模型作為研究平臺，以16位單片機STC16F40K128作為主控制單元，運用Keil軟件作為開發(fā)工具進行智能控制策略研究。

??道路信息檢測模塊普遍采用電感線圈和矯正電容組成電磁傳感器。本屆車模為電單車，前后輪縱向布置，前輪通過舵機控制轉向，后輪通過電機提供動力。

??在電源模塊設計中，采用TI公司開關電源芯片TPS5430和線性穩(wěn)壓電源芯片TPS7350分別產生6v、5v電壓，5v為編碼器供電；采用TPS7333作為穩(wěn)壓3.3V輸出，為單片機、模數轉換、串口通信模塊供電。單片機軟件算法部分為本文論述的重點，主要體現了智能車的串級PID控制策略，完成對單車的平衡及轉向控制，取得靜態(tài)指標和動態(tài)性能的雙贏。

??本篇技術報告將從智能車機械結構、硬件電路、軟件算法和調試方法等方面詳細介紹整個準備過程。

第一章 方案設計

??本章主要介紹智能汽車系統(tǒng)總體方案的選定和總體設計思路。

1.1 系統(tǒng)總體方案的選定

??本屆智能汽車比賽，我隊為單車拉力組別。在循跡傳感器方面，選用了電磁傳感器，電磁放大電路使用了TI公司的軌到軌運算放大器OPA2350。在速度控制方面，用AS5040磁性傳感器進行測速，進行速度閉環(huán)反饋，具有噪聲小的優(yōu)點。陀螺儀使用ICM42605采集三軸角速度、加速度數據，通過互補濾波解算得到角度信息。

1.2 系統(tǒng)總體方案的設計

??系統(tǒng)的硬件電路采用一體板的設計方式，小巧、緊密，保證單車機械結構的輕巧。設計上使用四層板設計，并對電源地進行合理分割，保證硬件電路的整體穩(wěn)定性以及各功能模塊的性能。

主控部分：

??包括一片STC16F40K128核心控制器和一片AD7606模數轉換芯片以及用于輔助操作調試的按鍵、OLED、撥碼器件，調試接口預留串口接口，外接HC-25 wifi模塊，方便調試與接受數據。

??輔助調試器件包括一個蜂鳴器，一個0.96寸OLED屏，四個按鍵和一個四聯撥碼，用于指示工作狀態(tài)、GUI菜單操作修改參數以及選擇預制檔位等功能。

電機驅動部分：

??電機驅動器采用mos管搭建H橋電路，具有電路簡單、驅動電流大、響應快的特點，可靠耐用。使用柵極驅動器IR2184驅動，控制信號通過74HC02D進行信號變換輸出給IR2184驅動H橋工作。測速留出6Pin 正交信號磁編碼器接口，通過D觸發(fā)器74HC74對AB相信號處理得到方向信息。

電源部分

??主要包括8.4V到6V降壓、5V穩(wěn)壓電路、外設和MCU的3.3V穩(wěn)壓電路和舵機電源電路。其中由于舵機擺角時瞬時功率較大同時對電源紋波要求并不嚴格，選用TPS5450開關電源供電。外設和單片機選用線性電源供電，所有5V外設均采用TI公司的高性能線性穩(wěn)壓器TPS7350進行供電，而3.3V使用一片TPS7333穩(wěn)壓。

電磁信號采集放大板部分：

??系統(tǒng)采用6.8nF電容和10mH電感配對采集電磁導引信號，經過TI公司高性能軌到軌放大器OPA2350放大后，進行倍壓整流，得到波動較小的直流電壓信號，并通過AD7606進行5通道同步采樣進行adc采集，使用SPI通信方式與MCU通信。

第二章 機械結構調整與優(yōu)化

??智能汽車各系統(tǒng)的控制都是在機械結構的基礎上實現的，因此在設計整個軟件架構和算法之前一定要對整個模型車的機械結構有一個全面清晰的認識，然后建立相應的數學模型，從而再針對具體的設計方案來調整賽車的機械結構，并在實際的調試過程中不斷的改進優(yōu)化和提高結構的穩(wěn)定性。本章將主要介紹K車模的機械結構和調整方案。

2.1 智能汽車車模的選擇

??本屆比賽單車拉力組我們使用K車模。

2.2 智能汽車傳感器的安裝

??車模中的傳感器包括有：速度傳感器（霍爾測速），電磁傳感器。下面分別介紹這些傳感器的安裝。

2.2.1 速度傳感器的安裝

??速度編碼器我們采用了AS5040磁性傳感器，安裝方法如下：

??將后車車輪軸處用AB膠沾上磁鐵，將磁性傳感器對準磁鐵，當車軸帶動磁鐵轉動時，磁性傳感器會切割磁力線產生方波用于測速。

??安裝時應注意調整好齒輪間隙。同樣的，電機齒輪與車輪的咬合也很重要。齒輪傳動機構對車模的驅動能力有很大的影響。齒輪傳動部分安裝位置的不恰當，會大大增加電機驅動后輪的負載，會嚴重影響行駛。調整的原則是：兩傳動齒輪軸保持平行, 齒輪間的配合間隙要合適，過松容易打壞齒輪，過緊又會增加傳動阻力，浪費動力；傳動部分要輕松、順暢，不能有遲滯或周期性振動的現象。判斷齒輪傳動是否良好的依據是，聽一下電機帶動后輪空轉時的聲音。聲音刺耳響亮，說明齒輪間的配合間隙過大，傳動中有撞齒現象；聲音悶而且有遲滯，則說明齒輪間的配合間隙過小，或者兩齒輪軸不平行，電機負載變大。調整好的齒輪傳動噪音很小，并且不會有碰撞類的雜音，后輪減速齒輪機構就基本上調整好了，動力傳遞十分流暢。

2.2.2電磁傳感器的安裝

??為了采集到更多的賽道信息，電磁傳感器擺放位置為車頭5個電磁傳感器，3個橫放，2個豎放。將電磁前瞻固定于單車前方20cm遠、15cm高的位置。。2.3.1 電路板的安裝

??為了使智能車具有較好的穩(wěn)定性，我們在搭建智能車時將一體板放到了K車的后座上，并用熱熔膠和尼龍柱牢固地固定到了車體上。

2.3.2 電池安放

??為了方便，將電池放到了K車電池倉內。

2.4 其他機械結構的調整

??另外，在模型車的機械結構方面還有很多可以改進的地方，其中最重要的是機械重心的調整。K車設計上質量分布不均勻，左邊要重于右邊。我們通過不斷嘗試，使左右質量分布接近一致，取得了較為接近的左右轉性能。

2.5 小結

??模型車的性能與機械結構有著非常密切的聯系。良好的機械結構是模型車提高速度的關鍵基礎。在同等的控制環(huán)境下，機械機構的好壞對其速度的影響十分顯著。我們非常重視對智能汽車的機械結構的改進，經過大量的理論研究和實踐，我們小車的左右質量分布均勻，重心集中車模低位，達到左右轉性能接近的效果，在高低速下均能取得不錯的控制，從而提高了小車整體的穩(wěn)定性和可靠性。

第三章 硬件電路方案設計

??本系統(tǒng)的硬件電路采用模塊化設計方式。主要包括單片機最小系統(tǒng)模塊、電源模塊、電磁信息采集模塊、測速模塊、顯示模塊等部分。

3.1 單片機最小系統(tǒng)模塊

??本設計的核心控制器為宏晶公司生產的16位單片機STC16F40K128,該單片機具有64引腳,具有豐富的系統(tǒng)資源和方便的外部電路接口，其中包括UART模塊，定時中斷模塊，IIC模塊，RAM存儲器，FLASH存儲器，EEPROM存儲器、PWM 模塊。

3.2 電源模塊

3.2.1 電池使用

??電源模塊是系統(tǒng)穩(wěn)定工作的基礎，因此，電源模塊輸出電壓和電流的穩(wěn)定性在整個智能車系統(tǒng)中起著非常重要的作用。

??電池采用3300mah 2s航模電池，該類型電池具有高效的利用率和穩(wěn)定的性能，一直被作為各種航模、電動車等的供電設備。為了獲得最高的性能和最長的壽命，該充電電池必須以正確的方法來使用。

??電池通常電流高，電池的爆發(fā)力會強些，但未必如電流低時飽滿。同時我們也

??必須注意充電電流不能過高，當電流過高時，不僅不能提高電池性能，反而會損壞電池，嚴重時會導致電池起火、爆炸。電池充滿電時，電壓大約為8.4V。在電池壓小于7.2V時，應注意及時充電，電池過放會對其造成不可逆轉的損害，電壓低于7.2V會對電池造成毀滅性傷害。

3.2.2 穩(wěn)6V電源模塊

??使用TI公司開關電源TPS5430降壓到6V供舵機使用。電路原理圖如3.1所示。

3.2.3 穩(wěn)5V電源模塊

??由于霍爾傳感器的額定工作電壓為5V，TPS7350是TI公司生產的高性能線性穩(wěn)壓芯片，其使用方便，電路的設計原理如圖3.2所示。

3.2.4 穩(wěn)3.3V電源模塊

??由于單片機的額定電壓為3.3V，串口通信也均為3.3V，因此，將電壓穩(wěn)定在3.3V并給各模塊供電是必不可少的。電路的設計原理如圖3.3所示。

3.3 電機驅動模塊

??本智能車系統(tǒng)車模的電機型號較小，對電機驅動的輸出電流的要求并不苛刻，因此本設計的驅動電路由4片mos管構成H橋。通過控制4個MOS管的導通和關斷來實現正反轉，并通過控制輸入的PWM波的占空比來調節(jié)電機兩端的平均電壓，達到控制電機的轉速的目的，具體電路圖如圖3.4所示。

3.4 電磁檢波模塊

??使用軌至軌運算放大器對電感電容對諧振得到的電磁信號進行放大檢波處理。具體電路圖如圖3.5所示。

3.5 AD7606 模數轉換

??AD7606數模轉換芯片最高采樣頻率200Khz，8通道同步采樣，同時還可以設置2倍、4倍、8倍、16倍、32倍、64倍過采樣，相當于做了硬件上的平滑濾波。AD7606通過SPI接口與單片機通信。

第四章 小車的控制方法

??類比于直立車直立環(huán)、速度環(huán)和方向環(huán)的三環(huán)控制，單車采用角速度環(huán)和角度環(huán)串級作為直立環(huán)，并且將循跡環(huán)疊加到角速度環(huán)中控制單車的轉向，這樣的控制方法內環(huán)角速度環(huán)可保證轉彎的及時，外環(huán)角度環(huán)又能保持車的直立姿態(tài)讓其不倒。

??單車的運動控制是一個欠驅動系統(tǒng)，按照單車的運動模型，后輪電機速度對單車的直立環(huán)也會產生影響，速度越快，則向心力越大，所以不同速度下單車傾角所對應的前輪舵機打角也不同。假設在勻速狀態(tài)下的參數正好適合，我們想到可以配合加減速來輔助直立環(huán)，在單車過彎道時減速，過彎后及時加速使單車回正，這樣的策略可以讓單車在過彎時起到壓彎的效果。

4.1 PID控制

【通用原理部分，此處省略3000字...】

4.2 單車平衡與轉向控制

4.2.1 ?單車平衡原理

??將自行車機器人看成由前輪、后輪以及車架所組成，并假設系統(tǒng)所有的質量都集中于質心上，根據質點系相對于動軸的動量矩定理，建立起自行車機器人的動力學方程，得到其單輸入單輸出系統(tǒng)的線性化模型。

??自行車機器人系統(tǒng)的結構參數如圖4.2所示。將自行車的前后輪與地面的接觸點記為 和 ，兩觸點間形成一條接觸線，與x軸之間的夾角定義為偏航角Ψ，的距離記為w。假定質心高度為h，質心在水平面上的投影點與的距離記為b。車體與z軸的夾角記為傾斜角Φ，前輪的擺角記為操縱角δ。

??自行車機器人結構的俯視圖如圖4.3所示。設自行車機器人在水平面內作平面運動，分別作點P1和P2的速度垂線并相交于Q點，Q點即為接觸線在水平面內作平面運動時的速度瞬心。設車體質量為m，自行車相對于接觸線P2P1的轉動慣量為J，后輪的速度為V。由此，得到自行車機器人做平面運動時的角速度和加速度分別為

??自行車機器人的質心在水平面的投影點繞點Q轉動，得到其速度Va，切向加速度ar，法向加速度an的表達式分別為

??系統(tǒng)所受的牽引慣性力為切向牽引慣性力和法向牽引慣性力的矢量和，其大小為

??依據剛體繞定軸轉動微分方程 ，得到系統(tǒng)動力學方程為

??當車體豎直時，可以認為各角度均為小量，即可得到系統(tǒng)的線性化模型為

4.2.2 單車平衡的穩(wěn)定性分析與仿真

??由4.2.1推導得出的系統(tǒng)線性化模型進一步分析，其開環(huán)傳遞函數為

??可知系統(tǒng)的零點為，極點為 ，在s域的右半平面始終存在一個極點，故開環(huán)系統(tǒng)不穩(wěn)定。對該系統(tǒng)構造簡單比例反饋閉環(huán)系統(tǒng)，令 ,得到此時閉環(huán)系統(tǒng)的特征方程為

??計算得出閉環(huán)系統(tǒng)特征根為

??由此得到使得特征根位于s平面左側時的反饋系數k與車速V的關系不等式為

??依據上式，定性得到了車速越大時閉環(huán)系統(tǒng)所需反饋系數越小的規(guī)律，反映在控制過程中，即車速越大時為了保持車身直立所需要的車把轉動角度就越小。

??進一步對控制模型進行修正與完善，將車體看成由四個剛體即車架、前輪、后輪、車把組成，考慮后輪轉速、前輪轉角對自行車平衡控制過程中的貢獻，即后輪車速、前輪轉角與車體橫滾角之前的定量關系。利用matlab對所建立的動力學方程進行仿真分析如下

??保持車身橫滾角一定時，后輪轉速與前輪轉角的關系如圖4.4所示。車速越慢，保持一定車身橫滾角所需要的前輪轉角就越大，反之則越小。并且，車速越慢，所能維持穩(wěn)定動平衡的車身橫滾角就越小。

??保持后輪轉速一定時，車身橫滾角度與前輪轉角的關系如圖4.5所示。一定范圍內，車身橫滾角越大，所需要的前輪轉角就越大。且隨著車速的提高，維持相同的車身橫滾角所需要的前輪轉角就越小。

4.2.3 單車平衡與轉彎

??自行車機器人的轉向控制通過改變目標平衡傾角從而改變車身動態(tài)平衡時的平衡姿態(tài)，做平面圓周運動。其轉彎半徑值由舵機打角、目標平衡傾角來決定。后輪轉速則影響了最大的平衡傾角以及一定平衡傾角下舵機打角值從而改變了轉彎半徑大小。而后輪速度、舵機打角、車身傾角與轉彎半徑之間的關系為一個比較復雜的非線性關系。

??實際調試中發(fā)現，在小傾角情況下，平衡控制效果。但是在左右轉向時呈現出了一個極為明顯的左右轉不對稱性，分析為自行車機器人的自身質量分布不均勻引起的。觀察發(fā)現，龍邱汽車電子提供的K車模自身結構存在一個不對稱的設計，即后輪電機沒有居中放置而是偏右，從而使得車的重心偏右，引起轉彎性能不對稱的現象。

??如圖4.6所示，保持車速一定，改變車身目標傾角時記錄車做穩(wěn)定圓周運動時的半徑的倒數即曲率大小。車身機械中值為3.7，左轉時目標傾角正向增大，右轉時目標傾角反向減小。分析發(fā)現，目前車身質量分布具有較大的不對稱性，表現為左轉時轉彎半徑的變化率是右轉時的兩倍左右，即相對于車身機械中值左右偏離相同傾角下，左轉的轉彎半徑較右轉時的要更小。

??通過添加配重塊可以一定程度上改善由車模本身質量分布不均勻引起的左右轉彎性能不對稱的問題。

??除了左右轉彎性能不對稱的問題，單車的直立控制只采用PD控制，不引入I項，便會存在一個靜態(tài)誤差，實際傾角往往會大于目標傾角，但是由于I項的慣性，在高速時便容易引起單車直立環(huán)發(fā)散，對此我們先采集數據，得到單車實際傾角與舵機打角的關系，然后在最終控制器的輸出值疊加上這個擬合值，基本可以實現實際傾角與目標傾角相貼合，并且單車的直立環(huán)不會發(fā)散。

??單車的直立控制配合上電機速度的加減速便可輔助單車的轉向，單車的加減速同樣采用PID控制器，輸入單車的實際傾角與目標傾角的差值，若實際傾角小于目標傾角則減速，反之則加速，這樣不但可以輔助單車的平衡，而且實際循跡的過程中可以達到入彎減速，出彎加速，達到過彎壓彎的效果。

4.3 單車循跡

??實現車模方向控制是保證車模沿著競賽道路比賽的關鍵，這里采用PD控制，單車是采用電磁循跡，我們使用兩個水平電感的差比和作為單車距離賽道的偏差值，但是實際發(fā)現當車遠離賽道一定位置時，差比和會出現先增大后減小的現象，于是我們通過中間的水平電感找到差比和突變的臨界點，并且在這個位置保持差只能增大，這樣就對差比和做了一個矯正，保持單車遠離賽道時差比和只會越來越大。

??再將得到的差比和值代入PD控制器，得到單車轉向的大小。將循跡環(huán)的輸出放到轉向環(huán)的輸入，即疊加到角速度環(huán)的目標值，即可實現單車循跡。

4.4 單車慢速運動控制

??單車拉力組今年除了要競速以外，還增加了慢賽道，這個時候需要以慢取勝，單車與其他組別不同，當速度減慢時，單車的平衡便成了一個棘手的問題。與高速時所采用的內外環(huán)PD控制加上角度與舵機打角的擬合的策略不同，這個時候利用擬合便不能調節(jié)得那么精細，所以我們慢速時內外環(huán)都采用PID控制器，此時單車轉彎的傾角只能限制在一個小范圍內。在循跡時單車容易出現抖動，而且會有一個低頻的晃動，容易發(fā)散，循跡時則需要給一個很小的P項配合一個相對較大的D項，這樣便可抑制單車的抖動。

第五章 開發(fā)調試

5.1 開發(fā)工具

??我隊成員自主設計開發(fā)適合攝像頭、光電組別的上位機。大體功能如下：

5.1.1 串口功能

1、普通查看接收功能

??選擇串口號，和波特率。默認串口號位所有可以使用的串口中號碼最小的，默認波特率位115200（考慮速度和誤碼率確定為115200），然后選擇"打開串口"。

2、普通發(fā)送功能

??必須打開串口此功能才能用。有"顯示發(fā)送了多少字節(jié)"功能，"清空顯示"功能，還可選擇"包含換行符"，"16進制發(fā)送"功能。

3、直接發(fā)送字節(jié)功能

4、藍牙調試功能

??使用此功能必須打開串口，然后"使能藍牙調試"框勾選。注意：

• AT BAUD：后邊是1,2,3,4,5,6,7等。4代表9600bps，8代表115200bps
• AT NAME：可以是英文或者數字組合。
• AT NAME：可以是英文或者數字組合。
• AT ROLE：后邊是0，1。0是從機，連接單片機，1是主機，連接電腦。

5.1.2 畫圖功能

??單片機程序：

第六章 車模主要參數

6.1 智能汽車外形參數

??經過改裝后，智能汽車的外形參數為：

• 車A:
• 車長：300mm；車寬：200mm；車高：150mm；車重：1kg

6.2 智能汽車技術參數

??智能汽車相關技術參數如表6.1所示：

項目	參數
車模軸距 輪距（毫米）	200 140
車模平均電流（勻速行駛）(毫安)	300
電路電容總量（微法）	800
傳感器種類及個數	測速編碼器 一個
LC電磁傳感器	五個
陀螺儀	一個
新增加伺服電機個數	0
賽道信息檢測空間精度（毫米）	10
賽道信息檢測頻率（次 秒）	150

結 ? ?論

??在這份報告中，我們主要從智能車機械結構、硬件電路、控制算法等方面介紹準備比賽的整個過程，針對單車拉力組別做出了很多改進，創(chuàng)新之處大體歸為以下兩點：

??1、ADC采集方案的改進：我隊并未使用單片機自帶的ADC模塊，而是使用一款高性能的模數轉換芯片AD7606，同時制作穩(wěn)定的參考電壓，實現多通道高精度同步采樣，同時這款芯片還可以設置不同倍數的過采樣實現硬件均值濾波，這樣減少了軟件上的工作量，同時更加可靠，采樣精度更高。。

??2、直立算法上將原先的單級PID改進為串級PID，內環(huán)為角速度環(huán)，外環(huán)為角度環(huán)，在高速和低速下均取得了較好的控制效果。

??智能車是培養(yǎng)大學生綜合動手能力的一個很好的且成熟的平臺，在這里每個人都會學有所得，做有所獲，懂得團隊的重要性，學會合作分工，找到自己擅長的一面，彌補自己的不足，在歡笑與痛苦中與隊友一同成長。

??希望這篇技術文檔會對未來參與智能車這項比賽的同學有所幫助！

參 考 文 獻

[1] 童詩白，華成英．模擬電子技術基礎[M]．北京. 高等教育出版社．2000?

[2] 邵貝貝. 嵌入式實時操作系統(tǒng)[LC／OS-Ⅱ(第2版)[M]. 北京．清華大學出版社．2004?

[3] 閻石.數字電子技術基礎[M].北京:高等教育出版社,1998.?

[4] 雷霏霖,梁志毅.基于CMOS傳感器 OV7620 采集系統(tǒng)設計[J].電子測量技術,2008,12(31):110-112.?

[5] 譚浩強.C程序設計[M].北京:清華大學出版社,2005.?

[6] 郭芳,曹桂琴.數據結構基礎[M].大連：大連理工大學出版社，1994.

[7] 邵貝貝.單片機嵌入式應用的在線開發(fā)方法[M].北京:清華大學出版社,2004.?

[8] 胡壽松.自動控制原理(第六版)[M].科學出版社,2014.?

[9] 張文春．汽車理論[M]．北京．機械工業(yè)出版社．2005

[10] YUAN Quan,ZHANG YunZhou,WU Hao,et al. ?Fuzzy Control Research In The Courses Of Smart Car[C]. ?Machine Vision and Human-Machine Interface (MVHI), Kaifeng,China, 2010: 764-767.?

[11] 侯虹.采用模糊PID控制律的舵機系統(tǒng)設計[J].航空兵器，2006,2(1):7-9.?

[12] 孫浩,程磊,黃衛(wèi)華,等.基于HCS12的小車智能控制系統(tǒng)設計[J].單片機與嵌入式系統(tǒng)應用,2007,03(16):51-54.?

[13] LU Zhenlin,LI Jingjiao,Zhang Minghui.Intelligent Control Research based on the Smart Car[C]. Advanced Computer Control (ICACC),Shenyang,2010:292-297.

※ 附錄 ※

附錄A：程序源代碼

附錄B：原理圖總圖