版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡介
1、<p><b> 畢 業(yè) 設(shè) 計(jì)</b></p><p> 基于電磁傳感器的智能車控制</p><p> 基于電磁傳感器的智能車控制</p><p> 完成日期: </p><p> 指導(dǎo)教師簽字: </p><p>
2、答辯小組成員簽字: </p><p> 分類號 密級 </p><p> UDC </p><p><b>
3、摘 要</b></p><p> 隨著智能交通系統(tǒng)(ITS)的研究在各國越來越被重視,智能車的控制技術(shù)也成為一項(xiàng)新興技術(shù),教育部決定舉辦基于高速發(fā)展的智能車技術(shù)為背景的“飛思卡爾杯”全國大學(xué)生智能車大賽。</p><p> 本設(shè)計(jì)以第六屆飛思卡爾杯全國智能車大賽為背景,系統(tǒng)以飛思卡爾公司的16位微控制器MC9S12XS128作為核心處理器,并綜合了傳感器技術(shù),自動(dòng)控制
4、技術(shù),信號處理技術(shù),單片機(jī)技術(shù),采用LC 諧振回路感應(yīng)電磁信號尋跡方案,同時(shí)配合編碼器、電機(jī)、舵機(jī)、電池以及相關(guān)驅(qū)動(dòng)電路來進(jìn)行信息的處理,使車模能夠以最合適的速度自主循線,并通過PID 方式對電機(jī)和舵機(jī)進(jìn)行相關(guān)調(diào)節(jié),最終以閉合回路的形式控制模型車高速穩(wěn)定地在跑道上行駛,使車具有更強(qiáng)的穩(wěn)定性與瞬時(shí)提速性能。</p><p> 在文中詳細(xì)介紹電磁智能車的設(shè)計(jì)方案,其中包括機(jī)械結(jié)構(gòu)的安裝與調(diào)整、硬件電路的設(shè)計(jì)與制作、
5、信號采樣策略、舵機(jī)的轉(zhuǎn)向控制、速度的閉環(huán)控制,以及與此次競賽相關(guān)的各類調(diào)試方法的思路和用到的相關(guān)調(diào)試工具。</p><p> 關(guān)鍵詞:微控制器; 電磁感應(yīng); PID; 自主循線; 閉環(huán)控制;</p><p><b> Abstract</b></p><p> With the study of the intelligent Trans
6、portation System (ITS) in the States are being taken seriously, Intelligent vehicle control technology has become an emerging technology. With the fast development of the intelligent vehicle technology, The Ministry of E
7、ducation holds the “Freescale Cup” National University Smart car Competition.</p><p> This design builds an intelligent vehicle control system based on the MC9S12X- S128 microcontroller,and combines sensor
8、technology, automatic control technology, signal processing technology, microprocessor technology. And determine the route by signal from oscillation circuits due to electromagnetic wave from the alternating curr- ent in
9、 the guiding wire. After processing the signal, CPU drives the car by controlling motor and steer engine and stops the car by distinguishing the termination by </p><p> The model system syncretizes intellig
10、ence and humanity, and shows outstanding security and stability. The system provides valuable experiences for further researches in coming future.</p><p> Key Word: Microcontroller;Electromagnetic induction
11、 ;PID;Self through the line;Closed-loop control</p><p><b> 目錄</b></p><p><b> 1緒論1</b></p><p> 2智能汽車控制系統(tǒng)總體設(shè)計(jì)1</p><p> 2.1 總體設(shè)計(jì)思路1</p>
12、;<p> 2.2 系統(tǒng)硬件結(jié)構(gòu)2</p><p> 2.3 系統(tǒng)軟件結(jié)構(gòu)3</p><p> 3智能汽車機(jī)械系統(tǒng)調(diào)整與安裝4</p><p> 3.1 前輪參數(shù)調(diào)整4</p><p> 3.1.1 主銷內(nèi)傾角4</p><p> 3.1.2 主銷后傾角4</p>&
13、lt;p> 3.1.3 前輪外傾角5</p><p> 3.1.4 前輪前束5</p><p> 3.2 后輪差速機(jī)構(gòu)調(diào)整5</p><p> 3.3 齒輪傳動(dòng)機(jī)構(gòu)調(diào)整6</p><p> 3.4 舵機(jī)安裝調(diào)整6</p><p> 3.4.1平躺式固定7</p><p&
14、gt; 3.4.2 站立式固定7</p><p> 3.5電路板的安裝8</p><p> 3.6速度傳感器的安裝8</p><p> 3.7傳感器的安裝9</p><p> 4智能汽車硬件電路設(shè)計(jì)10</p><p> 4.1 電源模塊10</p><p> 4.2
15、傳感器模塊10</p><p> 4.3 單片機(jī)模塊11</p><p> 4.3.1時(shí)鐘電路11</p><p> 4.3.2復(fù)位電路12</p><p> 4.3.3串口電路12</p><p> 4.4 驅(qū)動(dòng)模塊14</p><p> 4.5 起跑線檢測模塊14
16、</p><p> 5智能汽車控制算法與軟件設(shè)計(jì)15</p><p> 5.1 系統(tǒng)初始化15</p><p> 5.1.1 AD初始化15</p><p> 5.1.2 PWM初始化15</p><p> 5.1.3 串口初始化16</p><p> 5.2 磁場信號
17、的提取與處理17</p><p> 5.3 PID 控制算法及智能車中的應(yīng)用17</p><p> 5.3.1 PID 控制算法簡介17</p><p> 5.3.2 轉(zhuǎn)向控制的PD 調(diào)節(jié)20</p><p> 5.3.3 速度控制策略20</p><p> 5.4 起跑線檢測21</p&g
18、t;<p><b> 6開發(fā)與調(diào)試22</b></p><p> 6.1軟件開發(fā)環(huán)境介紹22</p><p> 6.2智能車整體調(diào)試23</p><p> 6.2.1舵機(jī)調(diào)試23</p><p> 6.2.2電機(jī)調(diào)試23</p><p> 6.2.3整體調(diào)試2
19、4</p><p><b> 7總結(jié)24</b></p><p><b> 參考文獻(xiàn)26</b></p><p><b> 致 謝27</b></p><p><b> 1緒論</b></p><p> 為加強(qiáng)大學(xué)
20、生實(shí)踐、創(chuàng)新能力和團(tuán)隊(duì)精神的培養(yǎng),促進(jìn)高等教育教學(xué)改革,受教育部高等教育司委托,由教育部高等自動(dòng)化專業(yè)教學(xué)指導(dǎo)分委員會(以下簡稱自動(dòng)化分教指委)主辦全國大學(xué)生智能汽車競賽。該競賽以智能汽車為研究對象的創(chuàng)意性科技競賽,是面向全國大學(xué)生的一種具有探索性工程實(shí)踐活動(dòng),是教育部倡導(dǎo)的大學(xué)生科技競賽之一。該競賽以 “立足培養(yǎng),重在參與,鼓勵(lì)探索,追求卓越”為指導(dǎo)思想,旨在促進(jìn)高等學(xué)校素質(zhì)教育,培養(yǎng)大學(xué)生的綜合知識運(yùn)用能力、基本工程實(shí)踐能力和創(chuàng)新意
21、識,激發(fā)大學(xué)生從事科學(xué)研究與探索的興趣和潛能,倡導(dǎo)理論聯(lián)系實(shí)際、求真務(wù)實(shí)的學(xué)風(fēng)和團(tuán)隊(duì)協(xié)作的人文精神,為優(yōu)秀人才的脫穎而出創(chuàng)造條件。 </p><p> 該競賽由競賽秘書處為各參賽隊(duì)提供/購置規(guī)定范圍內(nèi)的標(biāo)準(zhǔn)硬軟件技術(shù)平臺,競賽過程包括理論設(shè)計(jì)、實(shí)際制作、整車調(diào)試、現(xiàn)場比賽等環(huán)節(jié),要求學(xué)生組成團(tuán)隊(duì),協(xié)同工作,初步體會一個(gè)工程性的研究開發(fā)項(xiàng)目從設(shè)計(jì)到實(shí)現(xiàn)的全過程。該競賽融科學(xué)性、趣味性和觀賞性為一體,是以迅猛發(fā)展、
22、前景廣闊的汽車電子為背景,涵蓋自動(dòng)控制、模式識別、傳感技術(shù)、電子、電氣、計(jì)算機(jī)、機(jī)械與汽車等多學(xué)科專業(yè)的創(chuàng)意性比賽。該競賽規(guī)則透明,評價(jià)標(biāo)準(zhǔn)客觀,堅(jiān)持公開、公平、公正的原則,保證競賽向健康、普及,持續(xù)的方向發(fā)展。 </p><p> 本文以第六屆全國大學(xué)生智能汽車競賽為背景,為了保證智能汽車能夠具有迅捷的速度、遠(yuǎn)而清晰的前瞻以及較高的靈敏度與穩(wěn)定性,從軟硬件方面對系統(tǒng)進(jìn)行了優(yōu)化。</p><
23、p> 2智能汽車控制系統(tǒng)總體設(shè)計(jì)</p><p> 2.1 總體設(shè)計(jì)思路</p><p> 全國智能車比賽過程核心是速度與穩(wěn)定性權(quán)衡的過程,在保證賽車沖不出跑道的情況下追求速度最快,用時(shí)最短。因此,獲取有效、可靠的賽道信息以及實(shí)施合理的控制策略是保證比賽取得好成績的先決條件。</p><p> 該電磁智能車,是以黑線通有100mA左右、20K 的交流信
24、號線為引導(dǎo)線,依據(jù)電磁感應(yīng)的原理我們用LC 諧振回路為傳感器來采集信號,這樣采集到的信號是20K 的交流信號,但是信號強(qiáng)度很小,最后用三極管對采集到的信號進(jìn)行放大,最終將此信號送給單片機(jī)進(jìn)行處理。電磁感應(yīng)傳感器與以往的光電和攝像頭組的傳感器相比較,消耗的功率小了,但是其前瞻受到了明顯的限制。</p><p> 在控制策略方面,主要包括轉(zhuǎn)向控制和速度控制。對于舵機(jī)的轉(zhuǎn)向控制,我們采取經(jīng)典的位置式PD 算法,通過判
25、斷傳感器檢測到的直道或彎道信號給不同的PD 參數(shù),以達(dá)到不同的效果。對于電機(jī)的速度控制策略,采用PID 調(diào)節(jié)的同時(shí)引入反轉(zhuǎn)制動(dòng)剎車電路,使得小車在直道可以盡快加速并能保證在過彎時(shí)迅速減到過彎的速度,使得小車可以快速行駛。</p><p> 對于機(jī)械結(jié)構(gòu)方面,根據(jù)比賽情況的需要,對小車的機(jī)械結(jié)構(gòu)進(jìn)行合理安裝和調(diào)整,比如說重心的前后高低、兩只前輪的傾角、編碼盤的安裝、舵機(jī)的安裝、懸掛的松緊,主板的放置等,以保證小車
26、穩(wěn)定、快速的行駛。各個(gè)方面的之間的聯(lián)系如下圖所示:</p><p> 圖2.1 智能車總體結(jié)構(gòu)圖</p><p> 2.2 系統(tǒng)硬件結(jié)構(gòu)</p><p> 1) MC9S12XS128處理器:該模塊是整個(gè)系統(tǒng)的核心和大腦部件,所有的信息都要由它處理,結(jié)合該處理器,我們使用了最小系統(tǒng)。</p><p> 2) 采集模塊:采集模塊主要有賽
27、道信息采集和速度采集。我們經(jīng)過比較在賽道信息采集方面,我們用了電感;而在速度采集方面, 我們選用了編碼器。</p><p> 3) 驅(qū)動(dòng)模塊:主要有電機(jī)驅(qū)動(dòng)和舵機(jī)驅(qū)動(dòng)。該系統(tǒng)采用的是自行搭建的由場效應(yīng)管組成的H橋,效果很好。我們使用單獨(dú)一個(gè)穩(wěn)壓芯片給舵機(jī)供電。 </p><p> 4) 電源模塊:主要用到的5V LM294。</p><p> 5) 調(diào)試模塊:
28、調(diào)試模塊主要用到BDM。 </p><p> 2.3 系統(tǒng)軟件結(jié)構(gòu)</p><p> 系統(tǒng)硬件是整個(gè)系統(tǒng)的基礎(chǔ),系統(tǒng)軟件結(jié)構(gòu)則根據(jù)硬件和控制需求來制定。系統(tǒng)的基本軟件流程為:首先,對各功能模塊和控制參數(shù)進(jìn)行初始化。然后,通過電磁傳感器采集到的數(shù)據(jù)獲取前方賽道的情況,同時(shí)通過速度傳感器模塊獲取賽車的速度。采用PD 對舵機(jī)進(jìn)行反饋控制。另外根據(jù)檢測到的速度,結(jié)合速度控制策略,對賽車速度不斷
29、進(jìn)行適當(dāng)調(diào)整,使賽車在符合比賽規(guī)則的前提下,沿賽道快速行駛。</p><p> 圖2.2 軟件系統(tǒng)框圖</p><p> 3智能汽車機(jī)械系統(tǒng)調(diào)整與安裝</p><p> 車模的機(jī)械部分是影響其行駛性能最直接的部分,其重要性不言而喻。一個(gè)不良的機(jī)械系統(tǒng)會增加控制的難度,會為車模的速度提升帶來障礙。因此,車模的機(jī)械性能應(yīng)該是優(yōu)先考慮的問題。</p>
30、<p> 3.1 前輪參數(shù)調(diào)整 </p><p> 調(diào)試中發(fā)現(xiàn),在賽車過彎時(shí),轉(zhuǎn)向舵機(jī)的負(fù)載會因?yàn)檐囕嗈D(zhuǎn)向角度增大而增大。為了盡可能降低轉(zhuǎn)向舵機(jī)負(fù)載,對前輪的安裝角度,即前輪定位進(jìn)行了調(diào)整。 </p><p> 前輪定位包括主銷后傾角、主銷內(nèi)傾角、前輪外傾角和前輪前束四個(gè)內(nèi)容。車輪定位的作用是使汽車保持穩(wěn)定的直線行駛和轉(zhuǎn)向輕便,并減少汽車在行駛中輪胎和轉(zhuǎn)向機(jī)件的磨損。 &l
31、t;/p><p> 3.1.1 主銷內(nèi)傾角 </p><p> 從車前后方向看輪胎時(shí),主銷軸向車身內(nèi)側(cè)傾斜,該角度稱為主銷內(nèi)傾角。當(dāng)車輪以主銷為中心回轉(zhuǎn)時(shí),車輪的最低點(diǎn)將陷入路面以下,但實(shí)際上車輪下邊緣不可能陷入路面以下,而是將轉(zhuǎn)向車輪連同整個(gè)汽車前部向上抬起一個(gè)相應(yīng)的高度,這樣汽車本身的重力有使轉(zhuǎn)向車輪回復(fù)到原來中間位置的效應(yīng),因而舵機(jī)復(fù)位容易。 此外,主銷內(nèi)傾角還使得主銷軸線與路面交點(diǎn)
32、到車輪中心平面與地面交線的距離減小,從而減小轉(zhuǎn)向時(shí)舵機(jī)的拉力,使轉(zhuǎn)向操縱輕便,同時(shí)也可減少從轉(zhuǎn)向輪傳到舵機(jī)上的沖擊力。但主銷內(nèi)傾角也不宜過大,否則加速了輪胎的磨損,在調(diào)整時(shí)可以近似調(diào)整為0°~3°左右,不宜太大。 </p><p> 3.1.2 主銷后傾角</p><p> 從側(cè)面看車輪,轉(zhuǎn)向主銷(車輪轉(zhuǎn)向時(shí)的旋轉(zhuǎn)中心)向后傾倒,稱為主銷后傾角。設(shè)置主銷后傾角后,主
33、銷中心線的接地點(diǎn)與車輪中心的地面投影點(diǎn)之間產(chǎn)生距離(稱作主銷縱傾移距,與自行車的前輪叉梁向后傾斜的原理相同),使車輪的接地點(diǎn)位于轉(zhuǎn)向主銷延長線的后端,車輪就靠行駛中的滾動(dòng)阻力被向后拉,使車輪的方向自然朝向行駛方向。設(shè)定很大的主銷后傾角可提高直線行駛性能,同時(shí)主銷縱傾移距也增大。主銷縱傾移距過大,會使舵機(jī)沉重,而且由于路面干擾而加劇車輪的前后顛簸,通常主銷后傾角值設(shè)定在1°到3°。 </p><p&
34、gt; 模型車通過增減黃色墊片的數(shù)量來改變主銷后傾角的,由于競賽所用的轉(zhuǎn)向舵機(jī)力矩不大,過大的主銷后傾角會使轉(zhuǎn)向變得沉重,轉(zhuǎn)彎反應(yīng)遲滯,所以設(shè)置為0°,以便增加其轉(zhuǎn)向的靈活性。 </p><p> 主銷內(nèi)傾和主銷后傾都有使汽車轉(zhuǎn)向自動(dòng)回正,保持直線行駛的功能。不同之處是主銷內(nèi)傾的回正與車速無關(guān),主銷后傾的回正與車速有關(guān),因此高速時(shí)主銷后傾的回正作用大,低速時(shí)主銷內(nèi)傾的回正作用大。 </p>
35、;<p> 3.1.3 前輪外傾角 </p><p> 從前后方向看車輪時(shí),輪胎并非垂直安裝,而是稍微傾倒呈現(xiàn)“八”字形張開,稱為負(fù)外傾,而朝反方向張開時(shí)稱正外傾。前輪外傾角對汽車的轉(zhuǎn)彎性能有直接影響,它的作用是提高前輪的轉(zhuǎn)向安全性和轉(zhuǎn)向操縱的輕便性。前輪外傾角俗稱“外八字”,如果車輪垂直地面一旦滿載就易產(chǎn)生變形,可能引起車輪上部向內(nèi)傾側(cè),導(dǎo)致車輪聯(lián)接件損壞。所以事先將車輪校偏一個(gè)外八字角度,這
36、個(gè)角度約在1°左右。 </p><p> 模型車提供了專門的外傾角調(diào)整配件,近似調(diào)節(jié)其外傾角。由于競賽中模型主要用于競速,所以要求盡量減輕重量,其底盤和前橋上承受的載荷不大,所以外傾角調(diào)整為0°即可,并且要與前輪前束匹配。 </p><p> 3.1.4 前輪前束 </p><p> 腳尖向內(nèi),所謂“內(nèi)八字腳”的意思,指的是左右前輪分別向
37、內(nèi)。采用這種結(jié)構(gòu)目的是修正上述前輪外傾角引起的車輪向外側(cè)轉(zhuǎn)動(dòng)。如前所述,由于有外傾,舵機(jī)轉(zhuǎn)向變得容易。另一方面,由于車輪傾斜,左右前輪分別向外側(cè)轉(zhuǎn)動(dòng),為了修正這個(gè)問題,如果左右兩輪帶有向內(nèi)的角度,則正負(fù)為零,左右兩輪可保持直線行進(jìn),減少輪胎磨損。如圖下圖所示。</p><p> 圖3.1 輪前束示意圖</p><p> 3.2 后輪差速機(jī)構(gòu)調(diào)整 </p><p>
38、; 差速機(jī)構(gòu)的作用是在車模轉(zhuǎn)彎的時(shí)候,降低后輪與地面之間的滑動(dòng);并且還可以保證在輪胎抱死的情況下不會損害到電機(jī)。 </p><p> 當(dāng)車輛在正常的過彎行進(jìn)中 (假設(shè):無轉(zhuǎn)向不足亦無轉(zhuǎn)向過度),此時(shí)4 個(gè)輪子的轉(zhuǎn)速(輪速)皆不相同,依序?yàn)椋和鈧?cè)前輪>外側(cè)后輪>內(nèi)側(cè)前輪>內(nèi)側(cè)后輪。此次所使用車模配備的是后輪差速機(jī)構(gòu)。差速器的特性是:阻力越大的一側(cè),驅(qū)動(dòng)齒輪的轉(zhuǎn)速越低;而阻力越小的一側(cè),驅(qū)動(dòng)齒輪的轉(zhuǎn)速越高?以此次
39、使用的后輪差速器為例,在過彎時(shí),因外側(cè)前輪輪胎所遇的阻力較小,輪速便較高;而內(nèi)側(cè)前輪輪胎所遇的阻力較大,輪速便較低。 </p><p> 差速器的調(diào)整中要注意滾珠輪盤間的間隙,過松過緊都會使差速器性能降低,轉(zhuǎn)彎時(shí)阻力小的車輪會打滑,從而影響車模的過彎性能。好的差速機(jī)構(gòu),在電機(jī)不轉(zhuǎn)的情況下,右輪向前轉(zhuǎn)過的角度與左輪向后轉(zhuǎn)過的角度之間誤差很小,不會有遲滯或者過轉(zhuǎn)動(dòng)情況發(fā)生。 </p><p>
40、; 3.3 齒輪傳動(dòng)機(jī)構(gòu)調(diào)整 </p><p> 車模后輪采用BTS7970電機(jī)驅(qū)動(dòng)。電機(jī)軸與后輪軸之間的傳動(dòng)比為 18:76(電機(jī)軸齒輪齒數(shù)為18,后輪軸傳動(dòng)輪齒數(shù)為76)。齒輪傳動(dòng)機(jī)構(gòu)對車模的驅(qū)動(dòng)能力有很大的影響。齒輪傳動(dòng)部分安裝位置的不恰當(dāng),會大大增加電機(jī) 驅(qū)動(dòng)后輪的負(fù)載,從而影響到最終成績。調(diào)整的原則是:兩傳動(dòng)齒輪軸保持平行, 齒輪間的配合間隙要合適,過松容易打壞齒輪,過緊又會增加傳動(dòng)阻力,浪費(fèi)動(dòng)力;
41、傳動(dòng)部分要輕松、順暢,不能有遲滯或周期性振動(dòng)的現(xiàn)象。判斷齒輪傳動(dòng)是否良好的依據(jù)是,聽一下電機(jī)帶動(dòng)后輪空轉(zhuǎn)時(shí)的聲音。聲音刺耳響亮,說明齒輪間的配合間隙過大,傳動(dòng)中有撞齒現(xiàn)象;聲音悶而且有遲滯,則說明齒輪間的配合間隙過小,或者兩齒輪軸不平行,電機(jī)負(fù)載變大。調(diào)整好的齒輪傳動(dòng)噪音很小,并且不會有碰撞類的雜音,后輪減速齒輪機(jī)構(gòu)就基本上調(diào)整好了,動(dòng)力傳遞十分流暢。 </p><p> 3.4 舵機(jī)安裝調(diào)整 </p&g
42、t;<p> 舵機(jī)是賽車轉(zhuǎn)向的驅(qū)動(dòng)裝置,其性能的好壞直接關(guān)系到賽車的轉(zhuǎn)向性能和彎道的極限速度。而舵機(jī)的固定方式也在一定程度上決定了比賽的成敗。舵機(jī)轉(zhuǎn)向是整個(gè)控制系統(tǒng)中延遲較大的一個(gè)環(huán)節(jié),為了減小此時(shí)間常數(shù),通過改變舵機(jī)的安裝位置,而并非改變舵機(jī)本身結(jié)構(gòu)的方法可以提高舵機(jī)的響應(yīng)速度。下面介紹兩種方案,分別分析其性能。</p><p> 3.4.1平躺式固定 </p><p>
43、; 這種固定方式是車模上舵機(jī)的原安裝方式. </p><p><b> 優(yōu)點(diǎn): </b></p><p> 1)重心底,接近地盤,有利于車模的穩(wěn)定。 </p><p> 2) 兩臂前輪不等長,有利于車模的轉(zhuǎn)彎。(這里糾正一點(diǎn)誤區(qū),很多人認(rèn)為前輪的兩臂等長最好,其實(shí)不然。如果你是汽車專業(yè)的話 你就會明白他的原理,汽車上的轉(zhuǎn)向都是一邊長一邊
44、短的,轉(zhuǎn)向時(shí)內(nèi)側(cè)是要比外側(cè)的轉(zhuǎn)角要大,才有助于轉(zhuǎn)向的。) </p><p><b> 缺點(diǎn): </b></p><p> 1)在舵機(jī)和角度調(diào)節(jié)頭之間有介子作為受力緩沖作用的。但這在比賽中會延緩前輪的反應(yīng)時(shí)間。最好用AB膠將其固定死。 </p><p> 2)舵機(jī)的力臂太短。相比后兩種固定方式,舵機(jī)在相同的轉(zhuǎn)角下,前輪轉(zhuǎn)角會小得多,這在比賽
45、中是很不利的。因?yàn)槎鏅C(jī)轉(zhuǎn)角是需要時(shí)間的,這樣就延緩了前輪的轉(zhuǎn)動(dòng)效率。 </p><p> 3.4.2 站立式固定 </p><p> 這種固定方式是舵機(jī)豎立在車身中間位置。用兩等長的前輪拉桿住鏈接前輪。 </p><p><b> 優(yōu)點(diǎn): </b></p><p> 1)力臂長,前輪的反應(yīng)速度是平躺式的三倍左右(
46、由于力臂的長度會有所不同,力臂越長,反應(yīng)越快)。這里請注意一點(diǎn),力臂過長可能導(dǎo)致力矩不足,反而導(dǎo)致前輪轉(zhuǎn)不到位。因此設(shè)計(jì)時(shí)就要綜合考慮轉(zhuǎn)向機(jī)構(gòu)響應(yīng)速度與舵機(jī)力矩之間的關(guān)系,通過優(yōu)化得到一個(gè)最佳的轉(zhuǎn)向效果。建議力臂在3.5-4cm之間。 </p><p> 2)兩拉桿軸是等長的,所以車的左右轉(zhuǎn)是相同的。這里說明一點(diǎn),兩拉桿軸是等長并不和上述“轉(zhuǎn)向都是一邊長一邊短”相矛盾。因?yàn)槲覀兊淖罱K目地是使車模在轉(zhuǎn)向時(shí),內(nèi)側(cè)前
47、輪要比外側(cè)的轉(zhuǎn)角要大。當(dāng)舵機(jī)轉(zhuǎn)動(dòng)力臂時(shí),由于力臂的尾端是按曲線運(yùn)動(dòng)的,導(dǎo)致兩前輪的轉(zhuǎn)角不同,內(nèi)側(cè)前輪要比外側(cè)的轉(zhuǎn)角要大。 </p><p><b> 缺點(diǎn): </b></p><p> 1)使車模車頭整體重心過高,影響車模的穩(wěn)定性!經(jīng)測試,由于舵機(jī)固定的比較穩(wěn)定,此方案對小車的穩(wěn)定性影響幾乎為零。 </p><p> 分析舵機(jī)控制轉(zhuǎn)向輪轉(zhuǎn)
48、向的原理可以發(fā)現(xiàn),在相同的舵機(jī)轉(zhuǎn)向條件下,轉(zhuǎn)向連桿在舵機(jī)一端的連接點(diǎn)離舵機(jī)軸心距離越遠(yuǎn),轉(zhuǎn)向輪轉(zhuǎn)向變化越快。這相當(dāng)于增大力臂長度,提高線速度。針對上述特性,我們改變了舵機(jī)的安裝方式,選擇了站立式安裝,將舵機(jī)立起來安裝在車的中軸線上,使得左右兩輪的力臂一樣大,有利于轉(zhuǎn)向。 </p><p><b> 3.5電路板的安裝</b></p><p> 電路板是模型車上的核
49、心部分,在安裝時(shí),考慮到電路板的穩(wěn)定性和模型車的重心等問題,我們把電路板做的比較小。</p><p><b> 圖3.2智能車整體</b></p><p> 3.6速度傳感器的安裝</p><p> 為了不影響加速性能,編碼器的傳動(dòng)齒輪選擇相對較小,齒輪之間呈水平狀態(tài)。這樣安裝齒輪咬合很好,即避免由于齒輪咬合太緊以致加重負(fù)載,同時(shí)也避免了
50、因過松而出現(xiàn)的在轉(zhuǎn)動(dòng)中齒輪撞擊的現(xiàn)象,并減少電機(jī)的摩擦損耗和噪音。</p><p> 圖3.3 速度傳感器</p><p> 3.7傳感器的安裝 </p><p> 傳感器的安裝,為了獲得盡可能大的前瞻,我們將傳感器裝在車的最前端。傳感器的穩(wěn)定性直接關(guān)系到小車行駛狀況的好壞,所以,必須將其固定牢固。</p><p> 圖3.4 電磁傳
51、感器</p><p> 4智能汽車硬件電路設(shè)計(jì)</p><p> 電磁組智能車的硬件系統(tǒng)主要有以下幾個(gè)模塊組成:傳感器模塊、單片機(jī)模塊、電源模塊和驅(qū)動(dòng)模塊,以及調(diào)試模塊。為了調(diào)整整體車重心的穩(wěn)定,我們將各個(gè)模塊分散布局,下面將各個(gè)模塊詳細(xì)介紹。</p><p><b> 4.1 電源模塊</b></p><p>
52、 電源模塊為整個(gè)系統(tǒng)提供電力供應(yīng),其工作的穩(wěn)定性直接關(guān)系著小車其他電路模塊的正常工作,重要性不言而喻。在設(shè)計(jì)電源模塊時(shí),首先應(yīng)綜合考慮各模塊電路對電源功率的需求,然后根據(jù)需求選擇相應(yīng)的穩(wěn)壓芯片。集體原理圖如下:</p><p><b> 圖4.1 電源模塊</b></p><p><b> 4.2 傳感器模塊</b></p>&
53、lt;p> 電磁組的賽道信息是由20kHz、100mA 的交流電源流經(jīng)導(dǎo)線產(chǎn)生的交變磁場,如何將磁場信息檢測出來是傳感器設(shè)計(jì)的第一步。</p><p> 在具體的設(shè)計(jì)過程中,我們選擇了最傳統(tǒng)的電磁感應(yīng)線圈方案,這種方案的原理簡單,電路較易實(shí)現(xiàn),并且設(shè)計(jì)出來的傳感器體積小、價(jià)格便宜、功耗低,可以滿足小車競賽循跡的要求。</p><p> 比賽選擇20kHz 的交變磁場作為路徑的導(dǎo)
54、航信號,在頻譜上可以有效避開周圍其他磁場的干擾??梢岳肔C 并聯(lián)電路來實(shí)現(xiàn)選頻電路,對感應(yīng)信號進(jìn)行有效的放大。市場上購買比較方便的是10mH 的電感,根據(jù)LC 并聯(lián)諧振公式:</p><p> 可以計(jì)算出選頻所需的電容容值約為6.8nf,因此,在實(shí)際的電路中,我們選擇10mH的電感與6.8nf 的電容并聯(lián)來實(shí)現(xiàn)信號的選頻。</p><p> 在查閱了一些參數(shù)之后,我們選擇s8050對
55、選頻信號進(jìn)行放大,從示波器中,我們看出放大之后的信號較為可觀。</p><p> 圖4.2 信號放大模塊</p><p><b> 4.3 單片機(jī)模塊</b></p><p> 以MC9S12XS128 為核心的單片機(jī)系統(tǒng)的硬件電路設(shè)計(jì)主要包括以下幾個(gè)部分:時(shí)鐘電路、復(fù)位電路、串口電路。各個(gè)部分的功能如下:</p><
56、p> ?。?)時(shí)鐘電路給單片機(jī)提供一個(gè)外接的16MHz 的無源晶振。</p><p> (2)復(fù)位電路在電壓達(dá)到正常值時(shí)給單片機(jī)一個(gè)復(fù)位信號。</p><p> ?。?)串口電路使S12 與PC 機(jī)之間建立連接。</p><p><b> 4.3.1時(shí)鐘電路</b></p><p> 本系統(tǒng)采用的是標(biāo)準(zhǔn)的MC
57、9S12 系列單片機(jī)的時(shí)鐘電路,通過把一個(gè)16MHz 的外部晶振接在單片機(jī)的外部晶振輸入接口EXTAL 和XTAL 上,然后利用MC9S12XS128 內(nèi)部的壓控振蕩器和鎖相環(huán)(PLL)把這個(gè)頻率提高,作為單片機(jī)工作的內(nèi)部總線時(shí)鐘。原理圖如下:</p><p><b> 圖4.3 外部晶振</b></p><p><b> 4.3.2復(fù)位電路</b
58、></p><p> 本系統(tǒng)直接采用一個(gè)0.1uF 的電容提供低電平復(fù)位信號,手動(dòng)復(fù)位按鈕在系統(tǒng)調(diào)試時(shí)的作用很大。原理圖如下</p><p><b> 圖4.4 復(fù)位電路</b></p><p><b> 4.3.3串口電路</b></p><p> 串口電路S12上的串口接口T,R,
59、G分別與PC機(jī)上的2,3,5串口相接使S12 單片機(jī)與PC 機(jī)之間能夠通信,通過軟件處理將通過傳感器采集到的電壓信號又經(jīng)單片機(jī)上AD轉(zhuǎn)換的數(shù)值在串口精靈界面顯示,可以人性化的知道當(dāng)前小車所處的狀態(tài),串口在調(diào)試的過程中發(fā)揮著極大的作用。</p><p> 圖4.5 S12最小系統(tǒng)原理圖</p><p><b> 4.4 驅(qū)動(dòng)模塊</b></p><
60、;p> 驅(qū)動(dòng)電路采用兩片半橋元件BTS7970B 搭成全橋電路,可以控制電機(jī)的正反轉(zhuǎn)。原理圖如下:</p><p><b> 圖4.6 電機(jī)驅(qū)動(dòng)</b></p><p> 4.5 起跑線檢測模塊</p><p> 通??梢詸z測恒穩(wěn)磁場的手段有霍爾元件和干簧管?;魻栐膬?yōu)點(diǎn)在于輸出信號連續(xù),干簧管的優(yōu)點(diǎn)是電路簡單,對于定性檢測變
61、化明顯,干擾小。實(shí)際測試后發(fā)現(xiàn),兩者對于磁鐵的敏感度大致相同,同時(shí)霍爾元件產(chǎn)生的模擬信號對于后續(xù)處理不如干簧管的0、1 跳變直接,因而我們采用了干簧管。</p><p> 圖4.7 起跑線檢測電路</p><p> 5智能汽車控制算法與軟件設(shè)計(jì)</p><p><b> 5.1 系統(tǒng)初始化</b></p><p>
62、 由于我們采集的信號是正弦信號及模擬信號,因此初始化主要包括:AD 初始化、PWM 初始化、SCI串口初始化、鎖相環(huán)設(shè)置。</p><p> 5.1.1 AD初始化</p><p> MC9S12XS128 單片機(jī)的AD 轉(zhuǎn)換模塊主要有以下幾個(gè)特點(diǎn):8/10 位的轉(zhuǎn)換精度、7us 一次的轉(zhuǎn)換時(shí)間可編程采樣時(shí)間、外部觸發(fā)控制、轉(zhuǎn)換完成中斷、連續(xù)轉(zhuǎn)換模式、1 到8 轉(zhuǎn)換序列長度等。&l
63、t;/p><p><b> /*AD初始化*/</b></p><p> void vADInit(void)</p><p><b> {</b></p><p> ATD0CTL1=0b00000000;//8位精度 </p><p> ATD0CTL2=0b010
64、00000;//禁止外部觸發(fā),標(biāo)志位快速清零,中斷禁止</p><p> ATD0CTL3=0b10000000;//右對齊無符號.轉(zhuǎn)換序列長度為1,</p><p> No FIFO模式,Freeze模式下繼續(xù)轉(zhuǎn)換</p><p> ATD0CTL4=0b10100111;//4AD采樣周期ADClock=[BUSClock*0.5]/[PRS+1];<
65、;/p><p> ATD0CTL5=0b00110000;//特殊通道禁止,多通道采樣,</p><p> 掃描模式連續(xù)采樣,ch AN0</p><p> ATD0DIEN=0b00000000;//禁止數(shù)字輸入 </p><p><b> }</b></p><p> 5.1.2 PW
66、M初始化</p><p> PWM 調(diào)制波有8 個(gè)輸出通道,每個(gè)輸出通道都可以獨(dú)立的輸出,每個(gè)通道都有一個(gè)精確的計(jì)數(shù)器來計(jì)算脈沖的個(gè)數(shù),還有兩個(gè)可供選擇的時(shí)鐘源。其初始化的一般步驟是:禁止PWM、選擇時(shí)鐘、選擇極性、選擇對其模式、對占空比和周期進(jìn)行編程、使能PWM 通道。</p><p> 在本系統(tǒng)中需要兩路PWM 通道來分別控制舵機(jī)和電機(jī)的轉(zhuǎn)向和轉(zhuǎn)動(dòng)。舵機(jī)的PWM 是將0 和1 路的
67、PWM 合并后進(jìn)行控制,這樣可以是舵機(jī)的精度從1/255 提高到1/65535 其初始設(shè)置如下:</p><p> PWME=0x00; //關(guān)閉所有PWM</p><p> PWMCLK=0x03; //PWM45選用CLKA,PWM01選用CLKSA,</p><p> //PWM2367選用CLKB</p><p> PWMPR
68、CLK=0x30; //CLKA,0分頻,</p><p> //fBUS=32MHz,fCLKA=fBUS/0=24MHz</p><p> //CLKB,8分頻,</p><p> //fBUS=32MHz,fCLKB=fBUS/8=4MHz</p><p> PWMSCLA=12; //CLKSA,</p>
69、<p> //fCLKSA=fCLKA/(2*PWMSCLA)=1MHz</p><p> PWMPOL=0xFF;//PWM為正占空</p><p> PWMCAE=0x00; ///所有PWM為左對齊</p><p> PWMCTL=0xF0;///所有PWM合并端口</p><p> PWMPER01=20000
70、;//PWM01為舵機(jī)PWM01周期為20 000,則</p><p> //輸出PWM頻率為50Hz</p><p> PWMDTY01=1380;//PWM01占空比</p><p> PWME_PWME1=1;</p><p> 5.1.3 串口初始化</p><p> MC9S12系列單片機(jī)的串口通信
71、接口(Serial Communication Inteface)是一個(gè)通用的異步接受/發(fā)送器類型的異步通信接口,通過RS-232串行通信協(xié)議與主機(jī)系統(tǒng)通信。</p><p> //------初始化SCIO----------//</p><p> void SciInit(void){</p><p> SCI0BD=52;</p><
72、p> SCI0CR1=0;</p><p> SCI0CR2=0X2C;}</p><p> //----讀SCI數(shù)據(jù)---//</p><p> unsigned char SciRead() {</p><p> if(SCI0SR1_RDRF==1) {</p><p> SCI0SR1_RDR
73、F=1;</p><p> return SCI0DRL;}}</p><p> //---寫SCI數(shù)據(jù)---//</p><p> void SciWrite(unsigned char sendchar) {</p><p> while(!(SCI0SR1&0X80));</p><p> SC
74、I0DRH=0;</p><p> SCI0DRL=sendchar;}</p><p> 5.1.4 鎖相環(huán)設(shè)置</p><p><b> /*時(shí)鐘初始化*/</b></p><p> void PLL_Init(void) //PLLCLK=2*OSCCLK*(SYNR+1)/(REFDV+1)
75、 { //鎖相環(huán)時(shí)鐘=2*16*(2+1)/(1+1)=48MHz</p><p> REFDV=1; //總線時(shí)鐘=48/2=24MHz</p><p><b> SYNR=2;</b></p><p> while(!(CRGFLG&0x08));</p&
76、gt;<p> CLKSEL=0x80;</p><p><b> }</b></p><p> 5.2 磁場信號的提取與處理</p><p> 在本屆新增的電磁組智能車中,所檢測的信號是電磁信號,為連續(xù)的模擬量,及在整個(gè)跑道的橫向范圍能都能檢測到信號的存在,唯一的差異就是信號的強(qiáng)弱。Ⅱ:將整個(gè)跑道中檢測到的信號作為模擬量
77、進(jìn)行處理,這樣檢測到的信號離導(dǎo)線越近強(qiáng)度越大,在跑道的邊緣則信號越弱。</p><p> 第一排的傳感器主要工作是檢測當(dāng)前導(dǎo)線的位置。我們在第一排上放了4 個(gè)傳感器來檢測信號,然后根據(jù)各自的位置和檢測到的信號對得到的值進(jìn)行加權(quán)平均,這樣就得到了當(dāng)前黑線的位置。這樣根據(jù)得到的值可以得出當(dāng)前黑線與車身之間的夾角,然后將這一數(shù)據(jù)進(jìn)行處理轉(zhuǎn)化成PWM 信號送給舵機(jī)。</p><p> 5.3
78、PID 控制算法及智能車中的應(yīng)用</p><p> 5.3.1 PID 控制算法簡介</p><p> ?。?)比例調(diào)節(jié)(P)的作用:對偏差瞬間做出作出反應(yīng)。偏差一旦產(chǎn)生控制器立即產(chǎn)生控制作用,使控制量向著減少偏差的方向變化??刂谱饔玫膹?qiáng)弱取決于比例系數(shù) ,比例系數(shù) 越大,控制作用越強(qiáng),則過渡過程越快,控制過程的靜態(tài)偏差也就越??;但是 越大,也越容易產(chǎn)生振蕩,破壞系統(tǒng)的穩(wěn)定性。故而,比例
79、系數(shù) 選擇必須恰當(dāng),才能過渡時(shí)間少,靜差小而又穩(wěn)定的效果。</p><p> ?。?)積分調(diào)節(jié)(I)的作用:是使系統(tǒng)消除穩(wěn)態(tài)誤差,提高無差度。因?yàn)橛姓`差,積分調(diào)節(jié)就進(jìn)行,直至無差,一旦停止,積分調(diào)節(jié)輸出異常值。積分作用的強(qiáng)弱取決于積分時(shí)間常數(shù),越小,積分作用就越強(qiáng)。反之則積分作用弱,加入積分調(diào)節(jié)可使系統(tǒng)穩(wěn)定性下降,動(dòng)態(tài)響應(yīng)變慢。積分作用常與另兩種調(diào)節(jié)規(guī)律結(jié)合,組成 PI 調(diào)節(jié)器或 PID 調(diào)節(jié)器。</p&g
80、t;<p> ?。?)微分調(diào)節(jié)(D)的作用:阻止偏差的變化。它是根據(jù)偏差的變化趨勢(變化速度)進(jìn)行控制。偏差變化的越快,微分控制器的輸出就越大,并能在偏差值變大之前進(jìn)行修正。微分作用的引入,將有助于減小超調(diào)量,克服振蕩,使系統(tǒng)趨于穩(wěn)定,特別對高階系統(tǒng)非常有利,它加快了系統(tǒng)的跟蹤速度。但微分的作用對輸入信號的噪聲很敏感,對那些噪聲較大的系統(tǒng)一般不用微分,或在微分起作用之前先對輸入信號進(jìn)行濾波。</p><
81、p> 根據(jù) PID 控制器原理得知,PID 控制器的主要作用是快速平穩(wěn)地消除系統(tǒng)產(chǎn)生的偏差。</p><p> 圖5.1 模擬PID控制系統(tǒng)原理圖</p><p> 圖5.2不完全微分PID算法的車尋流程圖</p><p> ?。?)微分先行PID</p><p> 由于智能車在跑道上行駛時(shí),經(jīng)常會遇到轉(zhuǎn)彎的情況,所以智能車的速
82、度設(shè)定值和方向設(shè)定值都會發(fā)生頻繁的變化,從而造成系統(tǒng)的振蕩。為了解決設(shè)定值的頻繁變化給系統(tǒng)帶來的不良影響,本文在智能車的速度和方向控制上引入了微分先行PID 算法,其特點(diǎn)是只對輸出量進(jìn)行微分,即只對速度測量值和舵機(jī)偏轉(zhuǎn)量進(jìn)行微分,而不對速度和方向的設(shè)定值進(jìn)行微分。這樣,在設(shè)定值發(fā)生變化時(shí),輸出量并不會改變,而被控量的變化相對是比較緩和的,這就很好地避免了設(shè)定值的頻繁變化給系統(tǒng)造成的振蕩,明顯地改善了系統(tǒng)的動(dòng)態(tài)性能。</p>
83、<p> 圖5.3微分先行PID控制結(jié)構(gòu)圖</p><p> (5)前饋控制的應(yīng)用</p><p> 由于智能車的跑道寬度有限制,所以在經(jīng)過急轉(zhuǎn)彎的時(shí)候,如果速度和方向控制不及時(shí),智能車就可能沖出跑道。由于前饋控制是開環(huán)控制,所以前饋控制的響應(yīng)速度很快。將前饋控制引入到智能車的控制中,能夠提高舵機(jī)和伺服電機(jī)的反應(yīng)速度,改善智能車系統(tǒng)的動(dòng)態(tài)性能。</p>&l
84、t;p> ?。?)智能車控制系統(tǒng)結(jié)構(gòu)</p><p> 智能車的控制主要體現(xiàn)在兩個(gè)方面:一方面是方向的控制,也就是對舵機(jī)的控制;另一方面是對速度的控制,也就是對伺服電機(jī)的控制。舵機(jī)的數(shù)學(xué)模型較為簡單,具有很好的線性特征,只采用前饋控制;智能車的速度控制相對復(fù)雜一些,速度模型無法準(zhǔn)確建立,采用前饋-改進(jìn)PID 算法進(jìn)行控制。智能車的控制系統(tǒng)結(jié)構(gòu)如下圖 所示。</p><p> 圖5
85、.4 智能車的控制結(jié)構(gòu)圖</p><p> 圖5.4 中,分別是舵機(jī)和伺服電機(jī)數(shù)學(xué)模型。從圖中可以看出,智能車的方向控制和速度控制是相互獨(dú)立的,而且它們都是由路線偏差決定的。舵機(jī)轉(zhuǎn)角與路線偏差之間的對應(yīng)關(guān)系是根據(jù)舵機(jī)的數(shù)學(xué)模型得到的,在速度控制回路中,既包括反饋回路,又包括前饋環(huán)節(jié),伺服電機(jī)的控制量是在前饋補(bǔ)償基礎(chǔ)上,再由增量式PID 算法計(jì)算得到。</p><p> 5.3.2 轉(zhuǎn)向
86、控制的PD 調(diào)節(jié)</p><p> 智能車對方向的控制有兩點(diǎn)要求:在直道上,方向保持穩(wěn)定;在轉(zhuǎn)彎處,需要方向變化準(zhǔn)確而且迅速。只有這樣,才能保證智能車在跑道上高速、穩(wěn)定地運(yùn)行。為了提高方向控制的魯棒性,本文還對路線偏差進(jìn)行了模糊化處理。圖5是智能車方向模糊前饋控制的結(jié)構(gòu)圖,圖中分別是直道和彎道兩種情況下的前饋控制函數(shù)。</p><p> 圖5.5 智能車方向控制系統(tǒng)結(jié)構(gòu)圖</p&
87、gt;<p> 5.3.3 速度控制策略</p><p> 為了使智能車在直道上以較快速度運(yùn)行,在轉(zhuǎn)彎時(shí),防止智能車沖出跑道,則必須將智能車的速度降低,這就要求智能車的速度控制系統(tǒng)具有很好的加減速性能。當(dāng)智能車經(jīng)過連續(xù)轉(zhuǎn)彎的跑道時(shí),路線偏差的頻繁變化會造成速度設(shè)定的頻繁變化,這會引起速度控制系統(tǒng)的振蕩,并且微分環(huán)節(jié)對誤差突變干擾很敏感,容易造成系統(tǒng)的不穩(wěn)定。為了解決上述存在的問題,本文對數(shù)字PI
88、D 算法進(jìn)行了改進(jìn),將不完全微分和微分先行引入到PID 算法中,大大改善了速度控制系統(tǒng)的動(dòng)態(tài)性能。</p><p> 圖5.6 是智能車速度控制系統(tǒng)結(jié)構(gòu)圖</p><p> 由于賽道路況和智能車的姿態(tài)會經(jīng)常變化,所以速度控制系統(tǒng)的模型也是不定的,為了提高系統(tǒng)的適應(yīng)性,本文速度控制系統(tǒng)中采用了模糊PID 算法。將速度設(shè)定和實(shí)際速度進(jìn)行模糊分檔,通過調(diào)試得到不同情況下相對最優(yōu)的PID 參數(shù)
89、,保證了速度控制系統(tǒng)在不同情況下都有較好的控制效果。</p><p><b> 5.4 起跑線檢測</b></p><p> 電磁組智能車的起跑線與光電和攝像頭組的競賽都有所不同,它是以6 塊磁鐵為起跑線的檢測:</p><p> 圖5.7競賽跑道起跑區(qū)示意圖</p><p> 由于是以磁鐵為起跑線,如果用檢測導(dǎo)
90、線的傳感器去檢測起跑線是不現(xiàn)實(shí)的,所以我們采用干簧管為起跑線的檢測裝置。干簧管是一種磁敏的特殊開關(guān)。它通常由兩個(gè)或三個(gè)既導(dǎo)磁又導(dǎo)電材料做成的簧片觸點(diǎn),被封裝在充有惰性氣體(如氮、氦等)或真空的玻璃管里,玻璃管內(nèi)平行封裝的簧片端部重疊,并留有一定間隙或相互接觸以構(gòu)成開關(guān)的常開或常閉接點(diǎn)。當(dāng)永久磁鐵靠近干簧管時(shí),或者由繞在干簧管上面的線圈通電后形成磁場使簧片磁化時(shí),簧片的接點(diǎn)就會感應(yīng)出極性相反的磁極。由于磁極極性相反而相互吸引,當(dāng)吸引的磁力
91、超過簧片的抗力時(shí),分開的接點(diǎn)便會吸合;當(dāng)磁力減小到一定值時(shí),在簧片抗力的作用下接點(diǎn)又恢復(fù)到初始狀態(tài)。這樣便完成了一個(gè)開關(guān)的作用。</p><p><b> 6開發(fā)與調(diào)試</b></p><p> 6.1軟件開發(fā)環(huán)境介紹</p><p> Codewarrior是Metrowerks公司開發(fā)的軟件集成開發(fā)環(huán)境,飛思卡爾所有系列的微控制器都可
92、以在codewarrior IDE下進(jìn)行軟件開發(fā)。本模型車所用的處理器是MC9S12XS128,程序調(diào)試是在codewarrior IDE 3.1環(huán)境下實(shí)現(xiàn)的,所用語言為C語言。 </p><p> 首先要新建一個(gè)基于Mc9sDG128B的HCS12的工程,選用語言為C語言,具體的過程如圖7-1到7-2所示。建立好新的工程后,就可以在編譯器里進(jìn)行程序的編寫。</p><p> 圖6.1
93、 Codewarrioer新建工程界面</p><p> 圖6.2 CW_S12_v5.0_Special.工作界面</p><p> 6.2智能車整體調(diào)試</p><p><b> 6.2.1舵機(jī)調(diào)試</b></p><p> 首先在程序里不斷的修改舵機(jī)的控制量,確定舵機(jī)左轉(zhuǎn)和右轉(zhuǎn)極限的PWM值,記下該值留著在
94、程序里設(shè)定左轉(zhuǎn)和右轉(zhuǎn)的極限值。然后用一小段跑道來測試舵機(jī)的轉(zhuǎn)向,用不同的跑道段來測試模型車的轉(zhuǎn)向是否符合要求,當(dāng)用的是直道時(shí)候要保證模型車的舵機(jī)位置絕對的居中,小“S”道時(shí)候,模型車給出的轉(zhuǎn)角應(yīng)該足夠的小,大“S”時(shí)候轉(zhuǎn)角應(yīng)該近似為圓弧弦的角度,彎道時(shí)候要給足轉(zhuǎn)角。 </p><p> 6.2.2電機(jī)調(diào)試 </p><p> 像測試舵機(jī)一樣用不同的賽道來測試電機(jī)給出的轉(zhuǎn)速是否滿足實(shí)際控
95、制的需要,當(dāng)用的是小“S”道時(shí)候,模型車應(yīng)該保持直道上的速度,大“S”時(shí)候,應(yīng)該適當(dāng)?shù)臏p速,以使得通過時(shí)候不會產(chǎn)生過大的超調(diào),彎道時(shí)候要能夠很</p><p> 的將速度降下來,如果是急轉(zhuǎn)彎時(shí)可以不給控制量或者讓電機(jī)反轉(zhuǎn)以達(dá)到剎車的效果。 </p><p> 6.2.3整體調(diào)試 </p><p> 首先以一個(gè)較低的速度跑完整個(gè)賽道,然后再慢慢的提高速度,直到模
96、型車在某一個(gè)地方出錯(cuò),然后調(diào)整控制算法,如此反復(fù),直到模型車能夠以理想的速度,在理想的路線上運(yùn)行完為止。</p><p><b> 7總結(jié)</b></p><p> 本文詳細(xì)介紹了電磁智能車軟件與硬件結(jié)構(gòu)設(shè)計(jì)。 </p><p> 1.硬件部分主要包括車模的調(diào)整、電磁信號采集模塊、起止線檢測模塊和電機(jī)驅(qū)動(dòng)模塊。</p>&l
97、t;p> ?。?)對于前輪的調(diào)整主要影響的是賽車的轉(zhuǎn)向性能,包括前輪的主銷內(nèi)傾角、主銷后傾)、前束等幾方面。對于后輪的調(diào)整主要是差速機(jī)構(gòu)的調(diào)整,它的作用是在車模轉(zhuǎn)彎的時(shí)候,降低后輪與地面之間的滑動(dòng),并且還可以保證在輪胎抱死的情況下不會損害到電機(jī)。</p><p> ?。?)信號采集模塊主要由電磁探頭部分、電磁信號放大部分、霍爾傳感器部分及速度反饋部分組成。</p><p> ?。?)
98、探頭部分用工字型電感作為感應(yīng)磁場的媒介,這類電感體積小,Q值高,具有開放的磁芯,可以感應(yīng)周圍交變的磁場。為了加強(qiáng)探頭的選頻特性在電感上根據(jù)串聯(lián)了容值匹配的電容。??</p><p> 干簧管是用于起始線檢測的傳感器,根據(jù)大賽在賽道起始線會鋪設(shè)一排磁鋼,用干簧管檢測起始線電路簡單。</p><p> (4)電機(jī)驅(qū)動(dòng)模塊采用兩片BTS7960B半橋驅(qū)動(dòng)芯片驅(qū)動(dòng),該芯片負(fù)載電流可以達(dá)到43A
99、,而內(nèi)阻只有16 mΩ,十分適合賽車使用。 </p><p> 2.軟件部分主要包括舵機(jī)控制、電機(jī)控制和速度控制</p><p> (1)速度反饋模塊采用的是與電機(jī)用齒輪嚙合的光電編碼器,通過定時(shí)讀取光電編碼器即可達(dá)到測定車速進(jìn)而實(shí)現(xiàn)速度閉環(huán)控制的目的。</p><p> (2)舵機(jī)轉(zhuǎn)角與輸入的PWM之間關(guān)系十分穩(wěn)定,因此采用了直接根據(jù)信號給定PWM的控制方法
100、,即簡單的P控制。 </p><p> (3)電機(jī)轉(zhuǎn)速由于受到電池電壓、電機(jī)傳動(dòng)摩擦力、道路摩擦力和前輪轉(zhuǎn)向角度等等很多因素的影響,不能采用直接對應(yīng)的控制方法,而應(yīng)采用閉環(huán)控制。賽車的速度控制賽用的是PID算法,為了加快速度響應(yīng),又在期望速度與實(shí)際速度相差較大時(shí)預(yù)先引入一個(gè)預(yù)先標(biāo)定的開環(huán)函數(shù),雖然開環(huán)函數(shù)由于前面說到的原因不是很準(zhǔn)確但如果只作為PID算法的初始值的話還是可以極大的加快逼近速度的。P、I和D的系數(shù)
101、要根據(jù)賽道情況進(jìn)行調(diào)節(jié),調(diào)節(jié)思路是這樣的:當(dāng)賽車響應(yīng)不夠快時(shí),需要增大P項(xiàng)的系數(shù),但是P項(xiàng)系數(shù)的增大會帶來超調(diào)量的增大;當(dāng)超調(diào)量過大時(shí),可以增大D項(xiàng)系數(shù)來改善穩(wěn)態(tài)性能;I項(xiàng)可以消除穩(wěn)態(tài)誤差,但是會減慢賽車響應(yīng)。具體調(diào)節(jié)時(shí)需要根據(jù)實(shí)際情況來進(jìn)行參數(shù)調(diào)整。</p><p><b> 參考文獻(xiàn)</b></p><p> [1]卓晴,黃開勝,邵貝貝.學(xué)做智能車[M],北京
102、航空航天大學(xué)出版社,2007.3. </p><p> [2]邵貝貝.單片機(jī)嵌入式應(yīng)用的在線開發(fā)方法[M],北京:清華大學(xué)出版社,2004.10. </p><p> [3]童詩白·模擬電子技術(shù)基礎(chǔ)·北京:高等教育出版社,2001 </p><p> [4]譚浩強(qiáng)·C程序設(shè)計(jì)·北京:清華大學(xué)出版社,2001 </p
103、><p> [5]黃開勝 金華民 蔣荻南 “韓國智能模型車技術(shù)方案分析”,電子產(chǎn)品世界, 2006(5):150-152 </p><p> [6]沈長生.常用電子元器件使用一讀通[M].北京. 人民郵電出版社.2004 </p><p> [7]黃惟一 胡生清.《控制技術(shù)與系統(tǒng)》[M].機(jī)械工業(yè)出版社.2006.2. </p><p>
104、 [8]周斌 劉旺 林辛凡 郝杰 黃開勝.《智能車賽道記憶算法的研究》[J].電子產(chǎn)品世界.2006.8. </p><p> [9]林紅 周鑫霞.《數(shù)字電路與邏輯設(shè)計(jì)》[M].清華大學(xué)出版社.2005.11. </p><p> [10]閻石·數(shù)字電子技術(shù)基礎(chǔ)·北京:高等教育出版社,1998 </p><p> [11]朱衛(wèi)華. 一種微機(jī)
105、與單片機(jī)無線串行通信的設(shè)計(jì)方法. [D] 南華大學(xué),2002 年8 月. </p><p> [12]王宜懷 《嵌入式系統(tǒng)——使用HCS12微控制器的設(shè)計(jì)與應(yīng)用》北京航空航天大學(xué)出社 </p><p> [13]徐科軍 《傳感器與檢測技術(shù)》(第二版),電子工業(yè)出版社,2008年2月 </p><p> [14]吳曄 張陽 滕勤 《基于HCS12嵌入式系統(tǒng)設(shè)計(jì)》
106、 電子工業(yè)出版社 </p><p> [15]張睿 《Altium Designer 6.0原理圖與PCB設(shè)計(jì)》 電子工業(yè)出版社,2007年6月 </p><p> [16]肖玲妮 袁增貴.《Protel 99SE印刷電路板設(shè)計(jì)教程》[M].清華大學(xué)出版社.2004.10. </p><p> [17]張義和 《Altium Designer完全電路設(shè)計(jì)電路板
107、篇》機(jī)械工業(yè)出版社 </p><p> [18]張國雄 金篆芷.《測控電路》 [M].機(jī)械工業(yè)出版社.2001. </p><p> [19]陶永華,尹怡欣,葛蘆生·新型PID控制及其應(yīng)用·北京:機(jī)械工業(yè)出版社,1998 </p><p> [20]張宇河,董寧·計(jì)算機(jī)控制系統(tǒng)·北京:北京理工大學(xué)出版社,2002 <
108、;/p><p> [21]鄧兆祥,褚志剛等,“汽車前輪定位參數(shù)優(yōu)化設(shè)計(jì)”,重慶大學(xué)機(jī)械傳動(dòng)國家重點(diǎn)實(shí)驗(yàn)室. </p><p> [22]李太福.基于在線參數(shù)自整定的模糊PID 伺服控制系統(tǒng)[J] .交流伺服系統(tǒng),2005,4:203~215. </p><p> [23]夏克儉.?dāng)?shù)據(jù)結(jié)構(gòu) + 算法 [M] .北京:國防工業(yè)出版社, 2001. </p>
109、<p> [24]尹怡欣,陶永華.新型PID 控制及其應(yīng)用.北京:機(jī)械工業(yè)出版社,1998 年. </p><p> [25]Malian Sonka, Vaclav Hlavac, Roger Boyle . Image Processing, Analysis, and Machine, Vision, Second Edition[M],Thomson Learning and PT Pr
110、ess,19</p><p> [26]Stevens,A, Safety of driver interaction with in-vehicle information systems[J] Prcoceedings of the Institution of Mechanical engineers—Part D—Journal of Automobile Engineering.2000 214(6)
111、639-644</p><p><b> 致 謝</b></p><p> 在本次智能車大賽的準(zhǔn)備期間,我們不斷遇到問題,同時(shí)也不斷解決問題,一個(gè)個(gè)問題的解決見證了我們這支隊(duì)伍的成長。在此期間離不開老師、同學(xué)們的大力支持,是他們的幫助讓我們做得更好。 </p><p> 我在這里要感謝院領(lǐng)導(dǎo)的重視和支持,感謝馬世杰老師的悉心指導(dǎo),感謝學(xué)
溫馨提示
- 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 眾賞文庫僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。
最新文檔
- 畢業(yè)設(shè)計(jì)---基于光電傳感器的自動(dòng)循跡智能車系統(tǒng)設(shè)計(jì)
- 畢業(yè)設(shè)計(jì)---基于光電傳感器的自動(dòng)循跡智能車系統(tǒng)設(shè)計(jì)
- 基于激光傳感器的智能車設(shè)計(jì)
- 畢業(yè)設(shè)計(jì)(論文)+基于光電傳感器的自動(dòng)循跡智能車系統(tǒng)設(shè)計(jì)
- 基于無線傳感器的智能車控制研究.pdf
- 基于激光傳感器的智能車控制系統(tǒng)設(shè)計(jì).pdf
- 智能傳感器系統(tǒng)的電磁兼容設(shè)計(jì).pdf
- 傳感器畢業(yè)設(shè)計(jì)--礦用溫度傳感器設(shè)計(jì)
- 傳感器畢業(yè)設(shè)計(jì)
- 畢業(yè)設(shè)計(jì)---智能壓力傳感器系統(tǒng)設(shè)計(jì)
- 畢業(yè)設(shè)計(jì)---uego傳感器控制器設(shè)計(jì)
- 傳感器畢業(yè)設(shè)計(jì)
- 畢業(yè)論文-基于激光傳感器的智能車設(shè)計(jì)【精校排版】
- 電磁智能車畢業(yè)設(shè)計(jì)開題報(bào)告
- 基于CMOS圖像傳感器的智能車設(shè)計(jì)與實(shí)現(xiàn).pdf
- 傾角傳感器畢業(yè)設(shè)計(jì)
- 煙霧傳感器的設(shè)計(jì)畢業(yè)設(shè)計(jì)
- 傾角傳感器畢業(yè)設(shè)計(jì)
- 經(jīng)絡(luò)傳感器畢業(yè)設(shè)計(jì)
- 傳感器畢業(yè)設(shè)計(jì)外文翻譯--傳感器新技術(shù)的發(fā)展
評論
0/150
提交評論