汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì)【3張CAD圖紙+PDF圖】

喜歡這套資料就充值下載吧。。。資源目錄里展示的都可在線預(yù)覽哦。。。下載后都有，，請(qǐng)放心下載，，文件全都包含在內(nèi)，，【有疑問(wèn)咨詢QQ:414951605 或 1304139763】 ==========================================喜歡這套資料就充值下載吧。。。資源目錄里展示的都可在線預(yù)覽哦。。。下載后都有，，請(qǐng)放心下載，，文件全都包含在內(nèi)，，【有疑問(wèn)咨詢QQ:414951605 或 1304139763】 ==========================================

SY-025-BY-1 畢業(yè)設(shè)計(jì)題目審定表 指導(dǎo)教師姓名 張金柱 職稱(chēng) 教授 從事 專(zhuān)業(yè) 車(chē)輛工程 是否外聘 □是□否 題目名稱(chēng) 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 課題適用專(zhuān)業(yè) 車(chē)輛工程 課題類(lèi)型 設(shè)計(jì) 課題簡(jiǎn)介：本課題主要研究汽車(chē)側(cè)向穩(wěn)定性的控制，主要基于現(xiàn)有的ESP的控制內(nèi)容進(jìn)行設(shè)計(jì)和制作，現(xiàn)有的主要設(shè)備是北京現(xiàn)代的ESP泵，其他設(shè)備需要足部完善。就目前國(guó)際形勢(shì)來(lái)看，主要由博世等世界著名汽車(chē)電器制造公司設(shè)計(jì)和生產(chǎn)制造汽車(chē)側(cè)向穩(wěn)定性控制器，目前國(guó)內(nèi)做此類(lèi)設(shè)計(jì)的公司暫時(shí)空缺，全國(guó)有部分大學(xué)從事了側(cè)向穩(wěn)定性控制器的研究，為此，我們學(xué)校額不例外，特出此題。本設(shè)計(jì)的主要類(lèi)容有控制器的設(shè)計(jì)和控制器的原件的選擇，主要是基于橫擺角速度展開(kāi)相關(guān)側(cè)向穩(wěn)定性控制。本設(shè)計(jì)主要包括執(zhí)行器的控制，信號(hào)的采集，信號(hào)的處理，和相關(guān)的控制理論和控制算法等。 指導(dǎo)教師簽字： 年 月 日 教 研 室 意 見(jiàn) 1 選題與專(zhuān)業(yè)培養(yǎng)目標(biāo)的符合度 □好 □較好 □一般 □較差 2 對(duì)學(xué)生能力培養(yǎng)及全面訓(xùn)練的程度 □好 □較好 □一般 □較差 3 選題與生產(chǎn)、科研、實(shí)驗(yàn)室建設(shè)等實(shí)際的結(jié)合程度 □好 □較好 □一般 □較差 4 論文選題的理論意義或?qū)嶋H價(jià)值 □好 □較好 □一般 □較差 5 課題預(yù)計(jì)工作量 □較大 □適中 □較小 6 課題預(yù)計(jì)難易程度 □較難 □一般 □較易 教研室主任簽字： 年 月 日 系（部）教學(xué)指導(dǎo)委員會(huì)意見(jiàn)： 負(fù)責(zé)人簽字： 年 月 日 注：課題類(lèi)型填寫(xiě) W.科研項(xiàng)目；X.生產(chǎn)（社會(huì)）實(shí)際；Y.實(shí)驗(yàn)室建設(shè)；Z.其它。 SY-025-BY-3 畢業(yè)設(shè)計(jì)開(kāi)題報(bào)告 學(xué)生姓名 劉平藝 系部 汽車(chē)與交通工程學(xué)院 專(zhuān)業(yè)、班級(jí) 車(chē)輛工程07-2班 指導(dǎo)教師姓名 張金柱 職稱(chēng) 教授 從事 專(zhuān)業(yè) 車(chē)輛工程 是否外聘 是否□ 題目名稱(chēng) 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 一、課題研究現(xiàn)狀、選題目的和意義 （一）研究現(xiàn)狀 汽車(chē)側(cè)向穩(wěn)定性控制器的研究是從ABS(Anti-locked Braking System)開(kāi)始的。ABS在20世紀(jì)80年代開(kāi)始得到廣泛應(yīng)用，目前在國(guó)外已經(jīng)發(fā)展成為一種非常成熟的技術(shù)。國(guó)內(nèi)對(duì)ABS的研究始于80年代初，國(guó)內(nèi)研制ABS的單位主要有東風(fēng)汽車(chē)公司、交通部重慶公路研究所、重慶宏安ABS有限公司、陜西興平514廠、西安公路學(xué)院等單位和部門(mén)。東風(fēng)汽車(chē)公司從80年代初就開(kāi)始研究ABS，是較早研究ABS的廠家之一，現(xiàn)研究工作的主要目標(biāo)是對(duì)國(guó)外的產(chǎn)品進(jìn)行消化吸收，如將德國(guó)瓦布科公司的ABS裝于EQl45型汽車(chē)上進(jìn)行各種試驗(yàn)。重慶公路研究所相繼開(kāi)發(fā)出了兩代ABS產(chǎn)品，第一代ABS的ECU（Electronic Control Unit）采用了280芯片。第二代ABS產(chǎn)品為FKX．AC I型，該裝置的ECU中的CPU微處理器采用了美國(guó)INTEL公司的MCS．96系列8098單片機(jī)，但距離滿足實(shí)際應(yīng)用仍有一定的差距。1998年，重慶聚能汽車(chē)技術(shù)有限公司在國(guó)內(nèi)首家推出適合中國(guó)國(guó)情的電子式ABS防抱裝置，現(xiàn)已達(dá)到年產(chǎn)50萬(wàn)套的生產(chǎn)能力，是我國(guó)國(guó)內(nèi)最大的ABS生產(chǎn)基地。 電子穩(wěn)定程序ESP(Electronic Stability Program)是90年代初由德國(guó)奔馳公司開(kāi)發(fā)的車(chē)輛穩(wěn)定系統(tǒng)。從1995年至今，伴隨著理論研究的不斷深入和電子技術(shù)的發(fā)展，汽車(chē)穩(wěn)定性控制得到了很大的發(fā)展，并開(kāi)始作為選裝件安裝在一些中高檔轎車(chē)上。德國(guó)BOSCH公司一直是這方面技術(shù)的領(lǐng)先者，無(wú)論是ABS／ASR(Acceleration Slip Regulation -----驅(qū)動(dòng)防滑系統(tǒng))還是更先進(jìn)的ESP系統(tǒng)，技術(shù)上都一直處于領(lǐng)先地位，為國(guó)際大多數(shù)汽車(chē)廠商供應(yīng)ABS／ASR／ESP系統(tǒng)。1995年，博世成為首家把ESP投入量產(chǎn)的公司，早在1983年，博世的工程師就通過(guò)優(yōu)化的ABS控制系統(tǒng)來(lái)增強(qiáng)車(chē)輛在全力制動(dòng)時(shí)的穩(wěn)定性，博世在1987年注冊(cè)了相關(guān)的專(zhuān)利，1991年博世同戴姆勒-克萊斯勒公司開(kāi)始聯(lián)合開(kāi)發(fā)該項(xiàng)目基地。1995年3月電子穩(wěn)定控制系統(tǒng)開(kāi)始批量生產(chǎn)。同年，ESP成功用于梅賽德斯-奔馳汽車(chē)的S級(jí)車(chē)型上。在接下來(lái)的數(shù)年里，博世不斷優(yōu)化ESP的設(shè)計(jì)使得ESP開(kāi)始廣泛占領(lǐng)了轎車(chē)市場(chǎng)。 目前，全球有6家汽車(chē)零部件制造商生產(chǎn)ESP，他們是德國(guó)的博世，日本電裝，日本愛(ài)信精工，德國(guó)大陸Teves,美國(guó)德?tīng)柛＃绹?guó)TRW。 國(guó)內(nèi)汽車(chē)穩(wěn)定性控制的研究還處在起步階段，只有少數(shù)學(xué)者從事控制方法的仿真研究，而且由于缺少試驗(yàn)條件，研究還不十分深入，現(xiàn)在吉林大學(xué)、清華大學(xué)、上海交大、西北工大等高校和中國(guó)重汽集團(tuán)、上海大眾汽車(chē)制造公司等企業(yè)也在開(kāi)展相關(guān)的研究工作。東南大學(xué)車(chē)輛工程系對(duì)ESP系統(tǒng)的控制策略和其硬件實(shí)現(xiàn)進(jìn)行了相關(guān)研究，并用TMS320F2812系統(tǒng)實(shí)現(xiàn)了對(duì)車(chē)輛的ESP控制。 （二）選題的目的、意義 由于中國(guó)在汽車(chē)電子方面起步較晚，大多汽車(chē)電子控制系統(tǒng)都是借鑒或者直接引用外國(guó)的產(chǎn)品和技術(shù)，因此我們的設(shè)計(jì)基本都處在模仿的階段。本次課題就是基于單片機(jī)、橫擺角速度傳感儀，車(chē)輪角速度傳感儀、車(chē)速傳感器等，實(shí)現(xiàn)ESP的部分功能。 通過(guò)查看汽車(chē)事故原因的統(tǒng)計(jì)和分析結(jié)果不難發(fā)現(xiàn)，很多重大交通事故中，車(chē)輛往往由于在極端環(huán)境下車(chē)輪失去與地面的附著力而導(dǎo)致失控，例如在緊急避讓過(guò)程中，突然遇到濕滑、油污路面，或者在過(guò)彎當(dāng)中車(chē)速過(guò)快而導(dǎo)致的轉(zhuǎn)向不足和轉(zhuǎn)向過(guò)度，都有可能讓車(chē)輛失控。如果汽車(chē)裝有汽車(chē)側(cè)向穩(wěn)定性控制器（ESP）,將會(huì)大大減少汽車(chē)事故發(fā)生率，極大的提高汽車(chē)在各種路況下的安全行駛性能。ESP(電子穩(wěn)定系統(tǒng))通過(guò)傳感器得知車(chē)輛的抱死情況、車(chē)輛的橫擺慣量(簡(jiǎn)單理解為車(chē)身傾側(cè)的程度)，當(dāng)車(chē)輛出現(xiàn)失控趨勢(shì)時(shí)，對(duì)特定的車(chē)輪給予額外的制運(yùn)力，甚至通過(guò)調(diào)整車(chē)輛的牽引力，務(wù)求以最大的程度保持住車(chē)輪的附著力。在ESP的默默工作下，車(chē)輛遇到險(xiǎn)情時(shí)往往能夠化險(xiǎn)為夷。對(duì)于普通駕駛者而言，ESP自然顯得格外重要。 當(dāng)汽車(chē)進(jìn)行蛇形線路測(cè)試的時(shí)候就可以有效避免汽車(chē)的翻轉(zhuǎn)。ESP 系統(tǒng)不僅僅是在干燥路面上提高了汽車(chē)的穩(wěn)定性，還可以在路面附著性比較差的時(shí)候，諸如結(jié)冰、濕滑，以及碎石等情況下起作用。在上述不利狀況下，車(chē)輪與路面之問(wèn)的附著力降低，即使是最好的駕駛員也很難將高速行駛的汽車(chē)保持在預(yù)定的路線上，汽車(chē)容易發(fā)生側(cè)滑和跑偏，失去方向穩(wěn)定性，甚至在急轉(zhuǎn)彎的時(shí)候發(fā)生翻車(chē)事故，這時(shí)就需要一個(gè)可靠的汽車(chē)側(cè)向穩(wěn)定性控制器（ESP）來(lái)為駕駛員和乘客的安全保駕護(hù)航了。 二、設(shè)計(jì)（論文）的基本內(nèi)容、擬解決的主要問(wèn)題 （一）研究的基本內(nèi)容 1、研究汽車(chē)側(cè)向穩(wěn)定性控制器的硬件結(jié)構(gòu)和軟件驅(qū)動(dòng)原理，了解各個(gè)傳感器（橫擺角速度傳感器、車(chē)速傳感器、車(chē)輪角速度傳感器、方向盤(pán)轉(zhuǎn)角傳感器）、執(zhí)行器（ABS泵電磁閥）的功能、驅(qū)動(dòng)方法（電壓、電流、頻率范圍）等。 2、設(shè)計(jì)合適的系統(tǒng)擴(kuò)展電路，計(jì)算各個(gè)傳感器和單片機(jī)的接口電路并且制作電路。 3、針對(duì)汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì)要求，設(shè)計(jì)以單片機(jī)為核心的制動(dòng)控制系統(tǒng)，編寫(xiě)控制程序。 4、開(kāi)發(fā)完成軟件和硬件控制器,進(jìn)行技術(shù)指標(biāo)的針對(duì)性的試驗(yàn)。 （二）擬解決的主要問(wèn)題 1、對(duì)傳感器與單片機(jī)接口電路的制作。 2、軟件編程。 三、技術(shù)路線（研究方法） 1、確定本次設(shè)計(jì)ESP的技術(shù)指標(biāo) 2、完成功能指標(biāo)的硬件與軟件分工 硬件 軟件 3、傳感器接口電路的設(shè)計(jì) 6、軟件結(jié)構(gòu)設(shè)計(jì) 4、傳感器接口電路的制作 7、程序編制 5、硬件電路的測(cè)試 8、軟件測(cè)試 9、ESP系統(tǒng)測(cè)試與實(shí)驗(yàn) １、本次設(shè)計(jì)的主要技術(shù)指標(biāo)：①適用于輕型車(chē)；②利用橫擺角速度、車(chē)速傳感器、車(chē)輪角速度傳感器等，利用差動(dòng)制動(dòng)實(shí)現(xiàn)汽車(chē)橫擺力矩穩(wěn)定性控制。 ２、硬件功能分析：①車(chē)輪角速度傳感器４個(gè)，通過(guò)左右車(chē)輪角速度分析，得出左右車(chē)輪是否打滑，是否處于不同條件路面。②橫擺角和Ｇ傳感器總成（北京現(xiàn)代），判斷汽車(chē)的側(cè)向穩(wěn)定性程度的一個(gè)指標(biāo)。③電子尺，判別汽車(chē)轉(zhuǎn)向，控制后單輪幫助矯正轉(zhuǎn)向不足或者過(guò)多轉(zhuǎn)向。④車(chē)速傳感器（霍爾原理），與車(chē)輪轉(zhuǎn)角傳感器做比較分析，判別車(chē)輪的滑移率。⑤ＡＢＳ泵電磁閥，由電路控制開(kāi)啟和關(guān)閉，是制動(dòng)壓力增大或減小或者保持制動(dòng)壓力。⑥軟件功能，利用匯編語(yǔ)言完成傳感器與執(zhí)行器的聯(lián)系，完成ＥＳＰ功能。 ３、各個(gè)傳感器與單片機(jī)之間的連接電路的設(shè)計(jì)，做好限電壓限電流的準(zhǔn)備，保護(hù)單片機(jī)與傳感器的功能與性能。 ４、把設(shè)計(jì)好驅(qū)動(dòng)放大電路做成電路硬件。 ５、用萬(wàn)用表測(cè)量電路的各個(gè)接口端，看電路是否設(shè)計(jì)正確合理。 ６、設(shè)計(jì)軟件設(shè)計(jì)的流程圖。 四、進(jìn)度安排 （1）熟悉任務(wù)書(shū)，準(zhǔn)備資料，填寫(xiě)開(kāi)題報(bào)告 第1~2周（2月28日~3月13日） （2）確定控制算法策略 第3~4周（3月14日~3月27日） （3）對(duì)硬件進(jìn)行設(shè)計(jì)及電路的設(shè)計(jì)與制作 第5~6周（3月28日4月10日） （4）用單片機(jī)和C語(yǔ)言進(jìn)行軟件編程 第7~12周（4月11日~5月22日） （5）進(jìn)行實(shí)驗(yàn). 第13周（5月23日~5月29日） （6）指導(dǎo)老師評(píng)閱、審核及修改不足 第14~16周（5月30日~6月19日） （7）畢業(yè)設(shè)計(jì)答辯 第17周（6月20日~6月26日） 五、參考文獻(xiàn) [1]李朝青.單片機(jī)原理及接口技術(shù)[M].北京航空航天大學(xué)出版社，2005，(10). [2]謝維成,楊加國(guó).單片機(jī)原理與應(yīng)用及C51程序設(shè)計(jì)[M].清華大學(xué)出版社,2006,(8). [3]李涵武,趙雨旸.汽車(chē)電器與電子技術(shù)[M].哈爾濱工業(yè)大學(xué)出版社,2003,(9). [4]王望予.汽車(chē)設(shè)計(jì)[M].機(jī)械工業(yè)出版社.2004,(8). [5]韓安.基于嵌入式系統(tǒng)的汽車(chē)穩(wěn)定性控制器的開(kāi)發(fā)和研究[D].東南大學(xué),2009,(4). [6]宗長(zhǎng)福,鄭宇,田承偉,潘釗,董益亮.基于直接橫擺力矩控制器的汽車(chē)穩(wěn)定系控制策略[J]吉林大學(xué)學(xué)報(bào)，2008,(9). [7]歐健,房占鵬. 車(chē)輛動(dòng)力學(xué)穩(wěn)定性系統(tǒng)綜合反饋控制仿真[J].拖拉機(jī)與農(nóng)用運(yùn)輸車(chē),2010,(6). [8]陳勝金,李法宗,黃妙華. 波許ESP四通的理論分析[J].汽車(chē)技術(shù),2004,(2). [9] 李君．車(chē)輛ABS控制系統(tǒng)快速開(kāi)發(fā)研究[D].上海:上海交通大學(xué),2002. [10]楊妙梁.電子穩(wěn)定程序（ESP）[J].汽車(chē)與配件,萬(wàn)方數(shù)據(jù)，2005，（1-11）. [11]趙林峰,陳無(wú)畏,秦?zé)樔A,楊軍.地府找路面條件的ESP控制策略[J].機(jī)械工程學(xué)報(bào)，合肥:合肥工業(yè)大學(xué)機(jī)械與汽車(chē)工程學(xué)院,2011:109-114. [12]譚剛平,趙龍慶.汽車(chē)ABS邏輯門(mén)限值控制策略研究[J],西南林學(xué)院學(xué)報(bào),2006,(4):83—85. [13]Coad P,D North,M Mayfield Object ModelsStrategies,Patterns,and Applications[M], Englewood Cliffs,Prentice Hall,NJ,1995. [14]Jean J.Labrosse著,邵貝貝譯.嵌入式實(shí)時(shí)操作系統(tǒng)uc/os2[M].北京:北京航空航天大學(xué)出版社,2005,1-8. [15]涂志祥.基于模糊控制的汽車(chē)動(dòng)力學(xué)穩(wěn)定性控制(VDC)研究[D]. 湖南:長(zhǎng)沙理工大學(xué)汽車(chē)與機(jī)械工程學(xué)院, 2004: 49-50. [16]王家輝.汽車(chē)ESP系統(tǒng)半動(dòng)態(tài)測(cè)試臺(tái)架開(kāi)發(fā)[D].上海:上海交通大學(xué)，2004,3. [17]郭寬有.汽車(chē)操縱穩(wěn)定性的影響因素及評(píng)價(jià)方法研究[J].重慶工學(xué)院學(xué)報(bào)(自然科學(xué)版)，2007,10:28-32. 六、備注 指導(dǎo)教師意見(jiàn)： 簽字: 年 月 日 畢業(yè)設(shè)計(jì)（論文）開(kāi)題報(bào)告 設(shè)計(jì)（論文）題目: 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 院 系 名 稱(chēng): 汽車(chē)與交通工程學(xué)院 專(zhuān) 業(yè) 班 級(jí): 車(chē)輛工程B07-2 學(xué) 生 姓 名: 劉平藝 導(dǎo) 師 姓 名: 張金柱 開(kāi) 題 時(shí) 間: 2011年02月28號(hào) 指導(dǎo)委員會(huì)審查意見(jiàn)： 簽字： 年 月 日 SY-025-BY-2 畢業(yè)設(shè)計(jì)（論文）任務(wù)書(shū) 學(xué)生姓名 劉平藝 系部 汽車(chē)與交通工程 學(xué)院 專(zhuān)業(yè)、班級(jí) 車(chē)輛工程B07-2 指導(dǎo)教師姓名 張金柱 職稱(chēng) 教授 從事 專(zhuān)業(yè) 車(chē)輛工程 是否外聘 □是■否 題目名稱(chēng) 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 一、設(shè)計(jì)目的、意義 目的：在追求安全與動(dòng)力性越來(lái)越高的當(dāng)今社會(huì)，汽車(chē)智能制動(dòng)器扮演了越來(lái)越重要的角色，當(dāng)車(chē)輛有側(cè)滑的危險(xiǎn)，或者轉(zhuǎn)向不足時(shí)，ESP 就會(huì)分別對(duì)每個(gè)車(chē)輪施加不同的制動(dòng)力，就如車(chē)輛擁有四個(gè)制動(dòng)踏板。ESP不僅僅只是制動(dòng)車(chē)輪，還能夠主動(dòng)干預(yù)發(fā)動(dòng)機(jī)。駕駛者只要做出正確的轉(zhuǎn)向操作即可。 意義: 汽車(chē)側(cè)向穩(wěn)定系統(tǒng)或動(dòng)態(tài)偏航穩(wěn)定控制系統(tǒng)(Elect ronic St abilit y Program，ESP)是防抱死制動(dòng)系統(tǒng)ABS、驅(qū)動(dòng)防滑控制系統(tǒng)ASR、電子制動(dòng)力分配系統(tǒng)EBD、牽引力控制系統(tǒng)TCS 和主動(dòng)車(chē)身橫擺控制系統(tǒng)，ESP極大的為汽車(chē)行駛安全護(hù)航保駕，能有效減少汽車(chē)在雨、雪、泥、沙、冰等易滑路段的安全行駛 二、設(shè)計(jì)內(nèi)容、技術(shù)要求（研究方法） 設(shè)計(jì)的主要內(nèi)容：參照同類(lèi)硬件與軟件系統(tǒng)，分析原理與優(yōu)缺點(diǎn)，查閱資料，完成設(shè)計(jì)方向的認(rèn)識(shí)和確定，參考同類(lèi)控制器，完成主要技術(shù)參數(shù)的設(shè)定。 設(shè)計(jì)的主要技術(shù)要求：利用現(xiàn)有的器材(輪速傳感器、車(chē)速傳感器、方向盤(pán)轉(zhuǎn)角傳感器、汽車(chē)橫擺角速度傳感器)，自備單片機(jī)控制系統(tǒng)。利用單片機(jī)控制ABS泵電磁閥的開(kāi)啟和關(guān)閉，來(lái)實(shí)現(xiàn)汽車(chē)在各種路況的穩(wěn)態(tài)行駛。 三、設(shè)計(jì)完成后應(yīng)提交的成果 1、完成設(shè)計(jì)說(shuō)明書(shū)2萬(wàn)字以上； 2、完成單片機(jī)編程，程序完成ESP基本功能； 3、制作基本電路，完成硬件之間的正確鏈接； 4、調(diào)試軟件與硬件，做出初步實(shí)驗(yàn)數(shù)據(jù)； 5、分析實(shí)驗(yàn)數(shù)據(jù)，證明設(shè)計(jì)是合理。 四、設(shè)計(jì)進(jìn)度安排 （1）熟悉任務(wù)書(shū)，了解相關(guān)信息，準(zhǔn)備資料，填寫(xiě)開(kāi)題報(bào)告 第1~2周 （2）確定控制算法策略 第3~4周 （3）硬件進(jìn)行設(shè)計(jì)及電路的設(shè)計(jì)與制作 第5~7周 （4）用單片機(jī)和C語(yǔ)言進(jìn)行軟件編程 第8~11周 （5）進(jìn)行實(shí)驗(yàn)分析 第12~13周 （6）畢業(yè)論文總結(jié)、評(píng)閱、審核及修改不足 第14~16周 （7）為畢業(yè)論文答辯做準(zhǔn)備及答辯 第17周 五、主要參考資料 1、《 基于直接衡擺力矩控制的汽車(chē)穩(wěn)定性控制策略》 宗長(zhǎng)福 鄭宇 田承偉 潘釗 董益亮 吉林大學(xué)學(xué)報(bào)（工業(yè)版）2008年9月第38卷第5期 2、《基于嵌入式系統(tǒng)的汽車(chē)穩(wěn)定性控制器的開(kāi)發(fā)和研究》 韓安 東南大學(xué)碩士論文 指導(dǎo)教師 陳楠 3、《車(chē)輛動(dòng)力學(xué)穩(wěn)定性系統(tǒng)綜合反饋控制仿真》 歐健 房占鵬 重慶理工大學(xué) 《拖拉機(jī)與農(nóng)用運(yùn)輸車(chē)》 第37卷第3期 2010年6月 4、《車(chē)輛橫擺穩(wěn)定控制系統(tǒng)建模及控制方法研究》 李強(qiáng) 碩士論文 哈爾濱工業(yè)大學(xué) 2009年6月 5、《波許ESP四通的理論分析》陳勝金 李法宗 黃妙華 武漢理工大學(xué)汽車(chē)工程學(xué)院 汽車(chē)技術(shù) 2004年第二期 6、《基于直接橫擺力矩控制的汽車(chē)ESP控制系統(tǒng)研究》 唐耀鵬 長(zhǎng)安大學(xué)說(shuō)是學(xué)位論文 2009年5月 7、《單片機(jī)原理及接口技術(shù)》 徐煜明 韓雁 主編 電子工業(yè)出版社 8、《單片機(jī)原理與應(yīng)用及C51程序設(shè)計(jì)》 謝維成 楊加國(guó) 主編 清華大學(xué)出版社 六、備注 自學(xué)單片機(jī)編程與應(yīng)用軟件。 指導(dǎo)教師簽字： 年 月 日 教研室主任簽字： 年 月 日 SY-025-BY-4 畢業(yè)設(shè)計(jì)（論文）指導(dǎo)記錄 日期 地點(diǎn) 辦公室 指導(dǎo)方式 面授 指導(dǎo)記錄 （指導(dǎo)內(nèi)容、存在問(wèn)題及解決思路） 學(xué)生（記錄人）簽名： 指導(dǎo)教師簽名： 日期 地點(diǎn) 辦公室 指導(dǎo)方式 面授 指導(dǎo)記錄 （指導(dǎo)內(nèi)容、存在問(wèn)題及解決思路） 學(xué)生（記錄人）簽名： 指導(dǎo)教師簽名： 日期 地點(diǎn) 辦公室 指導(dǎo)方式 面授 指導(dǎo)記錄 （指導(dǎo)內(nèi)容、存在問(wèn)題及解決思路） 學(xué)生（記錄人）簽名： 指導(dǎo)教師簽名： SY-025-BY-5 畢業(yè)設(shè)計(jì)（論文）中期檢查表 填表日期 年 月 日 迄今已進(jìn)行 周剩余 周 學(xué)生姓名 劉平藝 系部 汽車(chē)與交通工程學(xué)院 專(zhuān)業(yè)、班級(jí) 車(chē)輛B07-2 指導(dǎo)教師姓名 張金柱 職稱(chēng) 教授 從事 專(zhuān)業(yè) 是否外聘 □是□否 題目名稱(chēng) 學(xué) 生 填 寫(xiě) 畢業(yè)設(shè)計(jì)（論文）工作進(jìn)度 已完成主要內(nèi)容 待完成主要內(nèi)容 　 　 存在問(wèn)題及努力方向 　 學(xué)生簽字： 指導(dǎo)教師 意 見(jiàn) 指導(dǎo)教師簽字： 年 月 日 教研室 意 見(jiàn) 教研室主任簽字： 年 月 日 SY-025-BY-6 畢業(yè)設(shè)計(jì)指導(dǎo)教師評(píng)分表 學(xué)生姓名 劉平藝 系部 汽車(chē)與交通工程 學(xué)院 專(zhuān)業(yè)、班級(jí) 車(chē)輛B07-2 指導(dǎo)教師姓名 張金柱 職稱(chēng) 教授 從事 專(zhuān)業(yè) 是否外聘 □是□否 題目名稱(chēng) 序號(hào) 評(píng) 價(jià) 項(xiàng) 目 滿分 得分 1 選題與專(zhuān)業(yè)培養(yǎng)目標(biāo)的符合程度，綜合訓(xùn)練情況；題目難易度 10 2 題目工作量；題目與生產(chǎn)、科研、實(shí)驗(yàn)室建設(shè)等實(shí)際的結(jié)合程度 10 3 綜合運(yùn)用知識(shí)能力（設(shè)計(jì)涉及學(xué)科范圍，內(nèi)容深廣度及問(wèn)題難易度）；應(yīng)用文獻(xiàn)資料能力 15 4 設(shè)計(jì)（實(shí)驗(yàn)）能力；計(jì)算能力（數(shù)據(jù)運(yùn)算與處理能力）；外文應(yīng)用能力 20 5 計(jì)算機(jī)應(yīng)用能力；對(duì)實(shí)驗(yàn)結(jié)果的分析能力（或綜合分析能力、技術(shù)經(jīng)濟(jì)分析能力） 10 6 插圖（圖紙）質(zhì)量；設(shè)計(jì)說(shuō)明書(shū)撰寫(xiě)水平；設(shè)計(jì)的實(shí)用性與科學(xué)性；創(chuàng)新性 20 7 設(shè)計(jì)規(guī)范化程度（設(shè)計(jì)欄目齊全合理、SI制的使用等） 5 8 科學(xué)素養(yǎng)、學(xué)習(xí)態(tài)度、紀(jì)律表現(xiàn)；畢業(yè)論文進(jìn)度 10 得 分 X= 評(píng) 語(yǔ)：（參照上述評(píng)價(jià)項(xiàng)目給出評(píng)語(yǔ)，注意反映該論文的特點(diǎn)） 　 　 　 　 　 　 　　 指導(dǎo)教師簽字： 年 月 日 SY-025-BY-7 畢業(yè)設(shè)計(jì)評(píng)閱人評(píng)分表 學(xué)生 姓名 劉平藝 專(zhuān)業(yè) 班級(jí) 車(chē)輛工程 指導(dǎo)教 師姓名 張金柱 職稱(chēng) 教授 題目 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 序號(hào) 評(píng) 價(jià) 項(xiàng) 目 滿分 得分 1 選題與專(zhuān)業(yè)培養(yǎng)目標(biāo)的符合程度，綜合訓(xùn)練情況；題目難易度 10 2 題目工作量；題目與生產(chǎn)、科研、實(shí)驗(yàn)室建設(shè)等實(shí)際的結(jié)合程度 10 3 綜合運(yùn)用知識(shí)能力（設(shè)計(jì)涉及學(xué)科范圍，內(nèi)容深廣度及問(wèn)題難易度）；應(yīng)用文獻(xiàn)資料能力 15 4 設(shè)計(jì)（實(shí)驗(yàn)）能力；計(jì)算能力（數(shù)據(jù)運(yùn)算與處理能力）；外文應(yīng)用能力 25 5 計(jì)算機(jī)應(yīng)用能力；對(duì)實(shí)驗(yàn)結(jié)果的分析能力（或綜合分析能力、技術(shù)經(jīng)濟(jì)分析能力） 15 6 插圖（圖紙）質(zhì)量；設(shè)計(jì)說(shuō)明書(shū)撰寫(xiě)水平；設(shè)計(jì)的實(shí)用性與科學(xué)性；創(chuàng)新性 20 7 設(shè)計(jì)規(guī)范化程度（設(shè)計(jì)欄目齊全合理、SI制的使用等） 5 得 分 Y= 評(píng) 語(yǔ)：（參照上述評(píng)價(jià)項(xiàng)目給出評(píng)語(yǔ)，注意反映該論文的特點(diǎn)） 　 　　 　 　 　 　 　　 　 　 　　 　 　 評(píng)閱人簽字 ： 年 月 日 SY-025-BY-8 畢業(yè)設(shè)計(jì)答辯評(píng)分表 學(xué)生 姓名 劉平藝 專(zhuān)業(yè) 班級(jí) 車(chē)輛B07-2 指導(dǎo) 教師 張金柱 職 稱(chēng) 教授 題目 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 答辯 時(shí)間 月 日 時(shí) 答辯組 成員姓名 出席 人數(shù) 序號(hào) 評(píng) 審 指 標(biāo) 滿 分 得 分 1 選題與專(zhuān)業(yè)培養(yǎng)目標(biāo)的符合程度，綜合訓(xùn)練情況，題目難易度、工作量、與實(shí)際的結(jié)合程度 10 2 設(shè)計(jì)（實(shí)驗(yàn)）能力、對(duì)實(shí)驗(yàn)結(jié)果的分析能力、計(jì)算能力、綜合運(yùn)用知識(shí)能力 10 3 應(yīng)用文獻(xiàn)資料、計(jì)算機(jī)、外文的能力 10 4 設(shè)計(jì)說(shuō)明書(shū)撰寫(xiě)水平、圖紙質(zhì)量，設(shè)計(jì)的規(guī)范化程度（設(shè)計(jì)欄目齊全合理、SI制的使用等）、實(shí)用性、科學(xué)性和創(chuàng)新性 15 5 畢業(yè)設(shè)計(jì)答辯準(zhǔn)備情況 5 6 畢業(yè)設(shè)計(jì)自述情況 20 7 畢業(yè)設(shè)計(jì)答辯回答問(wèn)題情況 30 總 分 Z= 答辯過(guò)程記錄、評(píng)語(yǔ)： 　 　 　 　 　 　 　 　 　 答辯組長(zhǎng)簽字： 年 月 日 SY-025-BY-9 畢業(yè)設(shè)計(jì)（論文）成績(jī)?cè)u(píng)定表 學(xué)生姓名 劉平藝 性別 男 系部 汽車(chē)與交通工程學(xué)院 專(zhuān)業(yè) 車(chē)輛工程 班級(jí) B07-2 設(shè)計(jì)（論文）題目 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 指導(dǎo)教師姓名 職稱(chēng) 指導(dǎo)教師 評(píng)分（X） 評(píng)閱教師姓名 職稱(chēng) 評(píng)閱教師 評(píng)分（Y） 答辯組組長(zhǎng) 職稱(chēng) 答辯組 評(píng)分（Z） 畢業(yè)設(shè)計(jì)（論文）成績(jī) 百分制 五級(jí)分制 答辯委員會(huì)評(píng)語(yǔ)： 答辯委員會(huì)主任簽字（蓋章）： 系部公章： 年 月 日 注：1、指導(dǎo)教師、評(píng)閱教師、答辯組評(píng)分按百分制填寫(xiě)，畢業(yè)設(shè)計(jì)（論文）成績(jī)百分制=0.3X+0.2Y+0.5Z 2、評(píng)語(yǔ)中應(yīng)當(dāng)包括學(xué)生畢業(yè)設(shè)計(jì)（論文）選題質(zhì)量、能力水平、設(shè)計(jì)（論文）水平、設(shè)計(jì)（論文）撰寫(xiě)質(zhì)量、學(xué)生在畢業(yè)設(shè)計(jì)（論文）實(shí)施或?qū)懽鬟^(guò)程中的學(xué)習(xí)態(tài)度及學(xué)生答辯情況等內(nèi)容的評(píng)價(jià)。 SY-025-BY-10 優(yōu)秀畢業(yè)設(shè)計(jì)推薦表 題 目 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 類(lèi)別 畢業(yè)設(shè)計(jì) 學(xué)生姓名 劉平藝 系、專(zhuān)業(yè)、班級(jí) 汽車(chē)與交通工程學(xué)院車(chē)輛工程07-2班 指導(dǎo)教師 張金柱 職 稱(chēng) 教授 設(shè)計(jì)成果明細(xì)： 答辯委員會(huì)評(píng)語(yǔ)： 答辯委員會(huì)主任簽字（蓋章）： 系部公章： 年 月 日 備 注： 注：“類(lèi)別”欄填寫(xiě)畢業(yè)論文或畢業(yè)設(shè)計(jì) 本科學(xué)生畢業(yè)設(shè)計(jì) 汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì) 院系名稱(chēng)： 汽車(chē)與交通工程學(xué)院 專(zhuān)業(yè)班級(jí)： 車(chē)輛工程07-2班 學(xué)生姓名： 劉平藝 指導(dǎo)教師： 張金柱 職 稱(chēng)： 教授 黑 龍 江 工 程 學(xué) 院 二○一一年六月 The Graduation Design for Bachelor's Degree Lateral Stability Controller Design for A Car Candidate：Liu Pingyi Specialty：Vehicle Engineering Class：B07-2 Supervisor：Prof. Zhang Jinzhu Heilongjiang Institute of Technology 2011-06·Harbin 黑龍江工程學(xué)院本科生畢業(yè)設(shè)計(jì) 摘 要 基于汽車(chē)主動(dòng)制動(dòng)側(cè)向穩(wěn)定系控制系統(tǒng)，使用的是汽車(chē)實(shí)際橫擺角速度與駕駛員期望值的差值來(lái)判定汽車(chē)的穩(wěn)態(tài)，同時(shí)引入了車(chē)輛質(zhì)心側(cè)偏角與經(jīng)驗(yàn)值進(jìn)行比較得到了另個(gè)一關(guān)于汽車(chē)轉(zhuǎn)彎穩(wěn)定的安全系數(shù)，希望由此改善和提高汽車(chē)在轉(zhuǎn)彎過(guò)程中的操縱穩(wěn)定性。 側(cè)向穩(wěn)定性控制系統(tǒng)判定車(chē)身狀態(tài)不穩(wěn)定時(shí)，可能是轉(zhuǎn)向不足或者是轉(zhuǎn)向過(guò)多。當(dāng)轉(zhuǎn)向不足時(shí)系統(tǒng)將制動(dòng)內(nèi)側(cè)后輪，轉(zhuǎn)向嚴(yán)重不足時(shí)，同時(shí)制動(dòng)多個(gè)車(chē)輪；當(dāng)出現(xiàn)轉(zhuǎn)向過(guò)多時(shí)，系統(tǒng)將制動(dòng)外側(cè)車(chē)輪，從而穩(wěn)定車(chē)輛，保證駕駛員和乘客的安全。 為了提高汽車(chē)側(cè)向穩(wěn)定性控制這個(gè)目標(biāo)，在控制過(guò)程中使用了汽車(chē)輪速傳感器、方向盤(pán)轉(zhuǎn)角傳感器、橫擺角和G傳感儀等信號(hào)源，控制部分包括制動(dòng)增壓電機(jī)、兩個(gè)吸入電磁閥、兩個(gè)隔離電磁閥、四個(gè)車(chē)輪的增壓和減壓電磁閥。通過(guò)相關(guān)算法，初步確定汽車(chē)穩(wěn)定和各個(gè)信號(hào)之間的關(guān)系，并實(shí)現(xiàn)側(cè)向穩(wěn)定性的初步控制。 關(guān)鍵詞：側(cè)向穩(wěn)定性；橫擺角；轉(zhuǎn)向不足；轉(zhuǎn)向過(guò)多；制動(dòng)；電磁閥 ABSTRACT Active braking lateral stability based on cars, use of control system is car actual yaw-rate expectations and drivers to determine the difference in value of car, and introduced the steady-state traffic PianJiao and experience value centroid side got another comparison about turning a stable security coefficient car, hope this improvement and improve automobile in turning process manipulation stability. Lateral stability control system determine body state unstable, may be understeering or move on to too much. When understeer medial rear brake system when will seriously insufficient, steering wheel, and braking when more than; When there is too much, the system will be steering wheels, and brake lateral stability vehicles, ensure the safety of drivers and passengers. In order to improve the car lateral stability control this goal, in process control the automobile wheel speed sensors will be uesd, steering wheel Angle sensor, yaw angles and G sensing devices such as signal source, the control part includes braking pressurization motor, two inhaled solenoid valve, two separate solenoid valve, four wheels of intensification and decompression solenoid valves. Through the related algorithm, preliminarily determined each signal car stability and the relationship between the lateral stability, and realize the preliminary control. Key words: Lateral stability; Yaw angles; Understeer; Steering overmuch; Braking; Electromagnetic valve II 目 錄 摘 要 I ABSTRACT II 第1章 緒論 1 1.1側(cè)向穩(wěn)定性控制器的研究意義 1 1.2 側(cè)向穩(wěn)定性控制器的優(yōu)點(diǎn) 1 1.3 國(guó)內(nèi)、外的現(xiàn)狀 2 1.4 研究?jī)?nèi)容 2 第2章 側(cè)向穩(wěn)定性控制器的結(jié)構(gòu)原理和控制方法 4 2.1 汽車(chē)側(cè)向穩(wěn)定性控制器的結(jié)構(gòu)組成 4 2.1.1汽車(chē)側(cè)向穩(wěn)定性控制系統(tǒng)的工作原理 4 2.1.2 側(cè)向穩(wěn)定性控制車(chē)輪制動(dòng)原理 6 2.1.3質(zhì)心側(cè)偏角速度與汽車(chē)穩(wěn)定性控制的聯(lián)系 6 2.1.4橫擺角與汽車(chē)穩(wěn)定性控制的聯(lián)系 7 2.2橫擺角速度、質(zhì)心側(cè)偏角與汽車(chē)穩(wěn)定性的控制策略 8 2.2.1閥門(mén)值和Y+、Y-的確定 9 2.3 控制算法設(shè)定占空比 11 2.4 本章小結(jié) 11 第3章 硬件系統(tǒng)的選擇與設(shè)計(jì) 12 3.1 控制器硬件系統(tǒng)概要 12 3.2傳感器的選擇與電路設(shè)計(jì) 13 3.2.1輪速傳感器的選擇與電路設(shè)計(jì) 13 3.2.2 方向盤(pán)轉(zhuǎn)角傳感器的選擇 14 3.2.3橫擺角和G傳感器總成的選擇 15 3.3液壓電磁閥回路系統(tǒng) 15 3.3.1液壓控制單元結(jié)構(gòu) 15 3.3.2液壓電磁閥控制回路 16 3.3.3驅(qū)動(dòng)電路的設(shè)計(jì) 17 3.3.4驅(qū)動(dòng)電路圖 18 3.4飛思卡爾MC9S12XS128單片機(jī) 18 3.4.1飛思卡爾S12芯片A/D轉(zhuǎn)化模塊特點(diǎn)： 19 3.4.2 PWM的主要特點(diǎn) 19 3.5 本章小結(jié) 20 第4章 軟件設(shè)計(jì) 21 4.1 軟件設(shè)計(jì)總體思路 21 4.2方向盤(pán)轉(zhuǎn)角（前輪轉(zhuǎn)角）信號(hào)的采集 22 4.3橫擺角信號(hào)與側(cè)向加速度信號(hào)的采集 22 4.4 輪速信號(hào)采集 23 4.5 PWM寄存器設(shè)置 24 4.6判斷穩(wěn)定系控制程序的編寫(xiě) 25 4.7 本章小結(jié) 28 第5章 實(shí)驗(yàn)與分析 29 5.1程序的下載 29 5.2測(cè)試A/D、PWM和I/O 32 5.3 側(cè)向穩(wěn)定性控制的實(shí)驗(yàn) 32 5.4 實(shí)驗(yàn)分析和結(jié)論 34 5.5 本章小結(jié) 35 結(jié) 論 36 參考文獻(xiàn) 37 致 謝 38 附 錄 39 附錄A 外文文獻(xiàn) 39 附錄B 外文文獻(xiàn)中文翻譯 45 附錄C 程序 50 第1章 緒論 1.1側(cè)向穩(wěn)定性控制器的研究意義 在汽車(chē)數(shù)量急劇增長(zhǎng)的今天，汽車(chē)安全性能越來(lái)中重要了，隨著汽車(chē)使用率的增加，汽車(chē)交通事故率也隨之直線上升。在很多重大交通事故中，車(chē)輛往往由于在極端環(huán)境下車(chē)輪失去與地面的附著力而導(dǎo)致失控。例如在緊急避讓過(guò)程中，突然遇到濕滑、油污路面，或者在過(guò)彎當(dāng)中車(chē)速過(guò)快而導(dǎo)致的轉(zhuǎn)向不足和轉(zhuǎn)向過(guò)度，都有可能讓車(chē)輛失控。 側(cè)向穩(wěn)定性控制器通過(guò)傳感器得知車(chē)輛的抱死情況、車(chē)輛的橫擺慣量(簡(jiǎn)單理解為車(chē)身傾側(cè)的程度)，當(dāng)車(chē)輛出現(xiàn)失控趨勢(shì)時(shí)，對(duì)特定的車(chē)輪給予額外的制運(yùn)力，甚至通過(guò)調(diào)整車(chē)輛的牽引力，務(wù)求以最大的程度保持住車(chē)輪的附著力。在側(cè)向穩(wěn)定性控制器的默默工作下，車(chē)輛遇到險(xiǎn)情時(shí)往往能夠化險(xiǎn)為夷。對(duì)于普通駕駛者而言，側(cè)向穩(wěn)定性控制器顯得格外重要。 當(dāng)汽車(chē)進(jìn)行蛇形線路測(cè)試的時(shí)候就可以有效避免汽車(chē)的翻轉(zhuǎn)。側(cè)向穩(wěn)定性控制系統(tǒng)不僅僅是在干燥路面上提高了汽車(chē)的穩(wěn)定性，還可以在路面附著性比較差的時(shí)候，諸如結(jié)冰、濕滑，以及碎石等情況下起作用。在上述不利狀況下，車(chē)輪與路面之問(wèn)的附著力降低，即使是最好的駕駛員也很難將高速行駛的汽車(chē)保持在預(yù)定的路線上，汽車(chē)容易發(fā)生側(cè)滑和跑偏，失去方向穩(wěn)定性，甚至在急轉(zhuǎn)彎的時(shí)候發(fā)生翻車(chē)事故，這時(shí)就需要側(cè)向穩(wěn)定性控制系統(tǒng)來(lái)拯救生命，減少、減輕意外交通事故的發(fā)生。 1.2 側(cè)向穩(wěn)定性控制器的優(yōu)點(diǎn) 側(cè)向穩(wěn)定性控制系統(tǒng)由控制單元及轉(zhuǎn)向傳感器（監(jiān)測(cè)方向盤(pán)的轉(zhuǎn)向角度）、車(chē)輪傳感器（監(jiān)測(cè)各個(gè)車(chē)輪的速度轉(zhuǎn)動(dòng)）、側(cè)滑傳感器（監(jiān)測(cè)車(chē)體繞垂直軸線轉(zhuǎn)動(dòng)的狀態(tài)）、橫向加速度傳感器（監(jiān)測(cè)汽車(chē)轉(zhuǎn)彎時(shí)的離心力）等組成?？刂茊卧ㄟ^(guò)這些傳感器的信號(hào)對(duì)車(chē)輛的運(yùn)行狀態(tài)進(jìn)行判斷，進(jìn)而發(fā)出控制指令，側(cè)向穩(wěn)定性控制器能有效的增強(qiáng)了汽車(chē)的安全性能。 (1)能控制啟動(dòng)防滑，有效加速啟動(dòng)，在加速階段使汽車(chē)得到最大的驅(qū)動(dòng)力。 (2)制動(dòng)防抱死，防止汽車(chē)出現(xiàn)因制動(dòng)抱死而失去轉(zhuǎn)向控制，有效減少制動(dòng)距離。 (3)橫擺力矩的控制，有效避免超速時(shí)的轉(zhuǎn)彎不足和過(guò)多轉(zhuǎn)向，極大的減少了車(chē)輛因轉(zhuǎn)向過(guò)多而側(cè)翻以及因轉(zhuǎn)向不足而沖出彎道引發(fā)的交通事故。 1.3 國(guó)內(nèi)、外的現(xiàn)狀 汽車(chē)側(cè)向穩(wěn)定性控制器的研究是從ABS開(kāi)始的。ABS在20世紀(jì)80年代開(kāi)始得到廣泛應(yīng)用，目前在國(guó)外已經(jīng)發(fā)展成為一種非常成熟的技術(shù)。國(guó)內(nèi)對(duì)ABS的研究始于80年代初，國(guó)內(nèi)研制ABS的單位主要有東風(fēng)汽車(chē)公司、交通部重慶公路研究所、重慶宏安ABS有限公司、陜西興平514廠、西安公路學(xué)院等單位和部門(mén)。東風(fēng)汽車(chē)公司從80年代初就開(kāi)始研究ABS，是較早研究ABS的廠家之一，現(xiàn)研究工作的主要目標(biāo)是對(duì)國(guó)外的產(chǎn)品進(jìn)行消化吸收，如將德國(guó)瓦布科公司的ABS裝于EQl45型汽車(chē)上進(jìn)行各種試驗(yàn)。重慶公路研究所相繼開(kāi)發(fā)出了兩代ABS產(chǎn)品，第一代ABS的ECU采用了280芯片。第二代ABS產(chǎn)品為FKX．AC I型，該裝置的ECU中的CPU微處理器采用了美國(guó)INTEL公司的MCS．96系列8098單片機(jī)，但距離滿足實(shí)際應(yīng)用仍有一定的差距。1998年，重慶聚能汽車(chē)技術(shù)有限公司在國(guó)內(nèi)首家推出適合中國(guó)國(guó)情的電子式ABS防抱裝置，現(xiàn)已達(dá)到年產(chǎn)50萬(wàn)套的生產(chǎn)能力，是我國(guó)國(guó)內(nèi)最大的ABS生產(chǎn)基地。 電子穩(wěn)定程序(ESP)是90年代初由德國(guó)奔馳公司開(kāi)發(fā)的車(chē)輛穩(wěn)定系統(tǒng)。從1995年至今，伴隨著理論研究的不斷深入和電子技術(shù)的發(fā)展，汽車(chē)穩(wěn)定性控制得到了很大的發(fā)展，并開(kāi)始作為選裝件安裝在一些中高檔轎車(chē)上。德國(guó)BOSCH公司一直是這方面技術(shù)的領(lǐng)先者，無(wú)論是ABS／ASR還是更先進(jìn)的ESP系統(tǒng)，技術(shù)上都一直處于領(lǐng)先地位，為國(guó)際大多數(shù)汽車(chē)廠商供應(yīng)ABS／ASR／ESP系統(tǒng)。1995年，博世成為首家把ESP投入量產(chǎn)的公司，早在1983年，博世的工程師就通過(guò)優(yōu)化的ABS控制系統(tǒng)來(lái)增強(qiáng)車(chē)輛在全力制動(dòng)時(shí)的穩(wěn)定性，博世在1987年注冊(cè)了相關(guān)的專(zhuān)利，1991年博世同戴姆勒-克萊斯勒公司開(kāi)始聯(lián)合開(kāi)發(fā)該項(xiàng)目基地。1995年3月電子穩(wěn)定控制系統(tǒng)開(kāi)始批量生產(chǎn)。同年，ESP成功用于梅賽德斯-奔馳汽車(chē)的S級(jí)車(chē)型上。在接下來(lái)的數(shù)年里，博世不斷優(yōu)化ESP的設(shè)計(jì)使得ESP開(kāi)始廣泛占領(lǐng)了轎車(chē)市場(chǎng)。 目前，全球有6家汽車(chē)零部件制造商生產(chǎn)ESP，他們是德國(guó)的博世，日本電裝，日本愛(ài)信精工，德國(guó)大陸Teves,美國(guó)德?tīng)柛＃绹?guó)TRW。 國(guó)內(nèi)汽車(chē)穩(wěn)定性控制的研究還處在起步階段，只有少數(shù)學(xué)者從事控制方法的仿真研究，而且由于缺少試驗(yàn)條件，研究還不十分深入，現(xiàn)在吉林大學(xué)、清華大學(xué)、上海交大、西北工大等高校和中國(guó)重汽集團(tuán)、上海匯眾汽車(chē)制造公司等企業(yè)也在開(kāi)展相關(guān)的研究工作。 1.4 研究?jī)?nèi)容 本次研究的內(nèi)容為汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì)，主要研究?jī)?nèi)容如下： （1）研究汽車(chē)側(cè)向穩(wěn)定性控制器的硬件結(jié)構(gòu)和工作原理，了解各個(gè)傳感器（橫擺角速度傳感器、車(chē)速傳感器、車(chē)輪角速度傳感器、方向盤(pán)轉(zhuǎn)角傳感器）、執(zhí)行器（ABS泵電磁閥）的功能、驅(qū)動(dòng)方法（電壓、電流、頻率范圍）等。 （2）根據(jù)設(shè)計(jì)要求和硬件條件，設(shè)計(jì)合適的擴(kuò)展電路， （3）針對(duì)汽車(chē)側(cè)向穩(wěn)定性控制器的設(shè)計(jì)要求，設(shè)計(jì)以單片機(jī)為核心的側(cè)向穩(wěn)定性控制系統(tǒng)，編寫(xiě)控制程序。 （4）開(kāi)發(fā)完成軟件和硬件控制器,進(jìn)行技術(shù)指標(biāo)的針對(duì)性的試驗(yàn)。 第2章 側(cè)向穩(wěn)定性控制器的結(jié)構(gòu)原理和控制方法 2.1 汽車(chē)側(cè)向穩(wěn)定性控制器的結(jié)構(gòu)組成 信號(hào)輸入 計(jì)算控制 傳感器 控制輸出 執(zhí)行器 圖2.1 側(cè)向穩(wěn)定性控制器結(jié)構(gòu)組成 控制器主要包括三部分：信號(hào)輸入、計(jì)算控制、響應(yīng)輸出三部分。 信號(hào)輸入包括：前輪或方向盤(pán)轉(zhuǎn)角信號(hào)、橫擺角速度信號(hào)、側(cè)向角速度信號(hào)、4個(gè)車(chē)輪轉(zhuǎn)速信號(hào)、主缸壓力信號(hào)等。 計(jì)算控制部分主要由飛思卡爾S12xs128單片機(jī)處理信號(hào)輸入，做出分析，然后判斷輸出，達(dá)到控制的目的。 輸出響應(yīng)部分包括：4個(gè)增壓閥（常開(kāi)）、4個(gè)減壓閥（常閉）、2個(gè)吸入閥（常閉）、2個(gè)隔離法（常開(kāi)）、2個(gè)吸入泵、1個(gè)電機(jī)。 2.1.1汽車(chē)側(cè)向穩(wěn)定性控制系統(tǒng)的工作原理 汽車(chē)穩(wěn)定性控制系統(tǒng)的ECU根據(jù)方向盤(pán)轉(zhuǎn)角傳感器和車(chē)速信號(hào)，通過(guò)計(jì)算來(lái)判斷駕駛員的駕駛意圖，計(jì)算出理想的車(chē)輛運(yùn)行狀態(tài)值。ECU根據(jù)檢測(cè)得到的實(shí)際車(chē)輛狀態(tài)與理想車(chē)輛狀態(tài)的誤差，通過(guò)一定的控制邏輯計(jì)算出可以使車(chē)輛恢復(fù)穩(wěn)定的汽車(chē)橫擺力矩，然后通過(guò)控制液壓調(diào)節(jié)器的電磁閥開(kāi)關(guān)動(dòng)作調(diào)節(jié)制動(dòng)系統(tǒng)各制動(dòng)輪缸的壓力來(lái)實(shí)現(xiàn)所需要的汽車(chē)橫擺力矩。改變后的車(chē)輛運(yùn)行狀態(tài)由傳感器測(cè)量到 ECU，然后再進(jìn)行下一循環(huán)的控制，從而使汽車(chē)保持穩(wěn)定。這就是汽車(chē)穩(wěn)定控制的一般工作原理。 下面以在低附著路面上緊急換道時(shí)的情況為例進(jìn)行詳細(xì)說(shuō)明。圖2.1和圖2.2分別為不施加穩(wěn)定性控制和施加穩(wěn)定性控制時(shí)車(chē)輛的運(yùn)行情況。圖2.1中，1為汽車(chē)直線行駛，沒(méi)有施加穩(wěn)定性控制的車(chē)輛駕駛員向左打方向盤(pán)2進(jìn)行換道操作，由于路面的摩擦系數(shù)不能提供足夠的側(cè)向力，于是在位置3時(shí)發(fā)生了過(guò)度轉(zhuǎn)向。這時(shí)車(chē)輛急速沿逆時(shí)針?lè)较蛐D(zhuǎn)，為了彌補(bǔ)這種過(guò)度轉(zhuǎn)向，駕駛員在位置4時(shí)向右急打方向盤(pán)作為補(bǔ)償，由于補(bǔ)償過(guò)度車(chē)輛又在位置5時(shí)發(fā)生了過(guò)度轉(zhuǎn)向，使得車(chē)輛急速沿順時(shí)針?lè)较蛐D(zhuǎn)。由于此時(shí)車(chē)輛的質(zhì)心側(cè)偏角很大，駕駛員通過(guò)方向盤(pán)對(duì)車(chē)輛的控制效果不明顯，從而引起慌亂，于是車(chē)輛失去控制而甩出。 圖2.1 不施加汽車(chē)穩(wěn)定控制的車(chē)輛在低附著路面上緊急換道 由圖2.2中可以看出，施加穩(wěn)定性控制的車(chē)輛駕駛員向左打方向盤(pán)2進(jìn)行換道操作，同樣在位置3時(shí)發(fā)生了過(guò)度轉(zhuǎn)向，汽車(chē)穩(wěn)定控制系統(tǒng)檢測(cè)到車(chē)輛發(fā)生了不穩(wěn)定狀態(tài)，于是通過(guò)對(duì)液壓調(diào)節(jié)器的調(diào)節(jié)使車(chē)輛產(chǎn)生抵消當(dāng)前過(guò)度轉(zhuǎn)向趨勢(shì)的沿順時(shí)針?lè)较虻臋M擺力矩，使車(chē)輛盡量按照駕駛員的操作來(lái)運(yùn)行。在位置4時(shí)駕駛員向右打方向盤(pán)完成換道操作，在位置5時(shí)又發(fā)生了不穩(wěn)定情況，汽車(chē)穩(wěn)定控制系統(tǒng)通過(guò)施加逆時(shí)針?lè)较虻钠?chē)橫擺力矩糾正了不穩(wěn)定趨勢(shì)。因此，盡管路面附著系數(shù)比較低，但在汽車(chē)穩(wěn)定控制系統(tǒng)的輔助下車(chē)輛還是比較好地依照駕駛員的意圖完成了換道操作。可見(jiàn)，汽車(chē)穩(wěn)定控制在保障汽車(chē)穩(wěn)定方面具有很大的優(yōu)勢(shì)。一般認(rèn)為，安裝汽車(chē)穩(wěn)定控制系統(tǒng)相對(duì)于沒(méi)有安裝在以下幾種情況下具有明顯效果：緊急移線或在低附著路面上移線；移線過(guò)程中突然制動(dòng)；在幅值很大的方向盤(pán)轉(zhuǎn)角下連續(xù)躲避障礙；轉(zhuǎn)向時(shí)伴隨著加速或制動(dòng)。 圖2.2 施加汽車(chē)穩(wěn)定控制的車(chē)輛在低附著路面上緊急換道 如上所述，當(dāng)汽車(chē)行駛在路面摩擦系數(shù)較低或者緊急轉(zhuǎn)向時(shí)是汽車(chē)最容易發(fā)生交通事故的工況，汽車(chē)穩(wěn)定控制系統(tǒng)在這些比較極端的工況下具有明顯的控制效果，因而可以大大提高汽車(chē)的主動(dòng)安全性。 2.1.2 側(cè)向穩(wěn)定性控制車(chē)輪制動(dòng)原理 如圖2．1所示，車(chē)輛在制動(dòng)時(shí)輪胎受到的受力分析。主要有地面對(duì)車(chē)輪產(chǎn)生的與車(chē)輛行進(jìn)方向相反的摩擦力，地面對(duì)輪胎的法向反作用力，同時(shí)地面還對(duì)輪胎有側(cè)向的側(cè)滑摩擦力。地面制動(dòng)力與地面對(duì)輪胎的法向反作用力之間的比值稱(chēng)為縱向附著系數(shù)。側(cè)滑摩擦力和法向反作用力之間的比值為側(cè)向附著系數(shù)。 圖2.3制動(dòng)時(shí)輪胎受力圖 由于法向作用力在車(chē)輛行駛的過(guò)程中保持不變，因此，車(chē)輛制動(dòng)時(shí)的縱向制動(dòng)力和側(cè)向制動(dòng)力與縱向附著系數(shù)和側(cè)向附著系數(shù)成正比。越大，縱向附著力越大，剎車(chē)的距離越短，大，側(cè)向附著力越大，車(chē)輛在制動(dòng)的過(guò)程中越容易控制方向，保證車(chē)輛不會(huì)產(chǎn)生側(cè)滑。 2.1.3質(zhì)心側(cè)偏角速度與汽車(chē)穩(wěn)定性控制的聯(lián)系 汽車(chē)在彎道時(shí)，由于本身就會(huì)產(chǎn)生橫擺和質(zhì)心側(cè)偏而引起失去彎道的跟蹤能力，從而跑出彎道失去控制穩(wěn)定性，汽車(chē)在失去穩(wěn)定的狀態(tài)，受環(huán)境的影響很大，當(dāng)達(dá)到極限附著力的時(shí)候，汽車(chē)的動(dòng)力學(xué)性能將被改變。 汽車(chē)的側(cè)偏力是由于路面的側(cè)向傾斜，側(cè)向風(fēng)或者汽車(chē)沿著曲線行駛時(shí)的離心力等作用，隨之使側(cè)偏角增加。路面情況不同，將會(huì)使車(chē)輪達(dá)到極限側(cè)偏的時(shí)間也不同，汽車(chē)達(dá)到飽和的時(shí)候側(cè)偏角的大小也不相同，高附著系數(shù)輪胎的側(cè)向極限比低附著系數(shù)的輪胎的極限側(cè)偏角要大。 在本實(shí)驗(yàn)中，認(rèn)定車(chē)輪的側(cè)偏系數(shù)是不變的。因此汽車(chē)的質(zhì)心側(cè)偏只與車(chē)速相關(guān)。相關(guān)實(shí)驗(yàn)證明，汽車(chē)的不穩(wěn)定狀態(tài)出現(xiàn)的時(shí)候，汽車(chē)的質(zhì)心側(cè)偏角增加很明顯，所以將質(zhì)心側(cè)偏角引入控制范圍，相關(guān)數(shù)據(jù)表明，在低附著系數(shù)的路面，質(zhì)心側(cè)偏對(duì)車(chē)輛的穩(wěn)定性狀態(tài)有很大的影響。簡(jiǎn)單的說(shuō)，車(chē)輛穩(wěn)定運(yùn)行時(shí)，地面的附著系數(shù)越低，車(chē)輛允許的質(zhì)心側(cè)偏角就越小。質(zhì)心側(cè)偏角的定義方法如下圖2.4所示，OXY為汽車(chē)車(chē)身坐標(biāo)系，汽車(chē)的合速度與X軸的夾角就是質(zhì)心側(cè)偏角。 圖2.4 質(zhì)心側(cè)偏角示意圖 質(zhì)心側(cè)偏公式如下： （2.1） 質(zhì)心側(cè)偏側(cè)偏角速度公式： （2.2） 是兩個(gè)相鄰控制周期質(zhì)心側(cè)偏角速度的差值，是ESP控制的周期，在這里設(shè)置為0.1秒。如公式（2.3） （2.3） 2.1.4橫擺角與汽車(chē)穩(wěn)定性控制的聯(lián)系 與汽車(chē)穩(wěn)定性緊密相關(guān)的另一個(gè)變量是橫擺角速度，本設(shè)計(jì)主要就是基于橫擺儀的信號(hào)來(lái)控制車(chē)輛的穩(wěn)定性的，在此前，先引入二自由度汽車(chē)模型。 為了方便控制，設(shè)計(jì)和分析中將忽略轉(zhuǎn)向系統(tǒng)的影響，既方向盤(pán)的輸入角度到前輪的轉(zhuǎn)角，可以認(rèn)為是等效的，同時(shí)特定的認(rèn)為：汽車(chē)沿x軸的前進(jìn)速度視為不變，汽車(chē)只有沿著y軸的側(cè)向運(yùn)動(dòng)和繞著z軸的橫擺運(yùn)動(dòng)。此外，汽車(chē)的側(cè)向加速度限定在0.4g以下，忽略左右輪胎的因載荷不同變化而引起的輪胎特性變化以及輪胎的回正力矩。因此，可以說(shuō)把汽車(chē)簡(jiǎn)化為摩托車(chē)的模型，整個(gè)系統(tǒng)概括為：一個(gè)由前后兩個(gè)有側(cè)向彈性輪的輪胎支撐地面，具有側(cè)向及橫擺運(yùn)動(dòng)的二自由度的汽車(chē)模型。如下圖2.5 圖2.5 二自由度汽車(chē)模型 通過(guò)二自由度汽車(chē)模型，引入理想橫擺角速度: （2.4） ——理想橫擺角速度，單位(rad/s) ——參考車(chē)速,單位(m/s)； ——前輪轉(zhuǎn)角，單位(rad/s)； L——軸距，單位m，在這里取2.55m； K——系數(shù)取值范圍0.003—0.004. 其中方向盤(pán)轉(zhuǎn)速與輪速之間的轉(zhuǎn)換可認(rèn)為是理想的，忽略方向轉(zhuǎn)角與前輪轉(zhuǎn)角的差值， 橫擺角速度直接表征的量就是汽車(chē)的轉(zhuǎn)向不足與轉(zhuǎn)向過(guò)多,如果定義汽車(chē)實(shí)際的橫擺角速度為Y,用實(shí)際橫擺角速度Y與理想橫擺角速度的差值公式如下： （2.5） 定義橫擺角速度向左為正，向右為負(fù)。 2.2橫擺角速度、質(zhì)心側(cè)偏角與汽車(chē)穩(wěn)定性的控制策略 在控制中，設(shè)置橫擺角速度閥門(mén)值為Y+ 和Y- ,質(zhì)心側(cè)偏角速度的閥門(mén)值設(shè)定為+B和-B，控制策略如下表2.1。 表2.1 控制策略 參考變量 控制策略 右前 右后 左前 左后 小增 小增 —— 小增 大增 小增 —— —— —— —— —— 小增 小增 —— —— —— —— —— 小增 大增 小增 —— 小增 小增 小增 小增 小增 —— 小增 大增 —— —— —— —— 小增 —— —— 小增 —— —— —— —— 大增 小增 —— 小增 小增 小增 —— 大增 大增 大增 大增 2.2.1閥門(mén)值和Y+、Y-的確定 通過(guò)查閱想過(guò)資料，得出橫擺角速度與時(shí)間的關(guān)系。由下圖可以看出，在橫擺角速度在1rad/s時(shí)，可以作為汽車(chē)側(cè)向穩(wěn)定性控制的一個(gè)門(mén)限值。 圖2.6 橫擺角速度與時(shí)間的關(guān)系 質(zhì)心側(cè)偏角速度為0.2rad/s時(shí)是控制的一個(gè)閥門(mén)值，當(dāng)質(zhì)心側(cè)角速度超過(guò)0.2rad/s還不給予控制超過(guò)時(shí)間1S后，汽車(chē)的可能性能極大的降低了，因此設(shè)定的閥門(mén)值為0.2rad/s。如下圖2.7 圖2.7 質(zhì)心側(cè)偏角速度與時(shí)間的關(guān)系 圖2.8 質(zhì)心側(cè)偏角速度和橫擺角速度 由上圖2.8可以看出，質(zhì)心側(cè)偏角速度和橫擺角速度有密切的聯(lián)系，這兩者同時(shí)控制，將極大的提高汽車(chē)的安全性能和可控性能。因此同時(shí)控制橫擺角速度和質(zhì)心側(cè)偏角速度是正確的選擇。 2.3 控制算法設(shè)定占空比 在汽車(chē)行駛過(guò)程中，車(chē)速與汽車(chē)的側(cè)向穩(wěn)定性有很大的關(guān)系，基本呈線性上升，簡(jiǎn)而言之，汽車(chē)的速度越高，汽車(chē)失去穩(wěn)定性控制的機(jī)會(huì)就越大。因此要求在汽車(chē)高速行駛時(shí)，對(duì)汽車(chē)的控制更加快和準(zhǔn)，而在汽車(chē)低速時(shí)，對(duì)駕駛員而言，控制可以相對(duì)較慢，如果高占空比高頻控制，可能降低汽車(chē)的舒適性，因此設(shè)定占空比和車(chē)速成線性控制，在控制算法中稱(chēng)為比例控制。 具體控制流程如下圖2.9： 控制算法 控制PWM占空比 Duty0 車(chē)速 Duty2, Duty1 圖2.9 車(chē)速控制PWM流程圖 具體公式如下： （2.6） Duty2在初始時(shí)為0，的初始值也為0，在控制算法完成后，將本周期的Duty1賦值給Duty2，同時(shí)將本周期的的結(jié)果賦值給。 Duty0是占空比的初始值，在表2.1中設(shè)置車(chē)速為0時(shí)，小增時(shí)占空比為20%，大增設(shè)置為40%。Kv的初選值具體看第4章程序設(shè)置。 2.4 本章小結(jié) 本章主要介紹了側(cè)向穩(wěn)定性控制器的組成、原理和工作過(guò)程，還介紹了車(chē)輪制動(dòng)控制的原理和主要控制的理論方法和控制策略。為第四章軟件編程做了鋪墊。 第3章 硬件系統(tǒng)的選擇與設(shè)計(jì) 3.1 控制器硬件系統(tǒng)概要 筆記本電腦 橫擺角和G傳感儀 BDM 橫向拉桿位移尺 A/D 飛思卡爾S12XS128 單片機(jī) 信號(hào)放大除雜 輪速傳感器x4 I/O 控制信號(hào) 信號(hào)放大隔離電路 泵電機(jī) 左前輪增壓閥 右前輪增壓閥 左后輪增壓閥 右后輪增壓閥 左隔離閥 右隔離閥 左吸入閥 右吸入閥 左前輪減壓閥 右前輪減壓閥 左后輪減壓閥 右后輪減壓閥 圖3.1 硬件連線 上圖是本設(shè)計(jì)的主要硬件關(guān)系連接圖，主要硬件以及功能如下：1、電腦，用于編程設(shè)計(jì);2、BDM,用于連接電腦與單片機(jī)之間的通信，下載電腦的程序到單片機(jī)；3、飛思卡爾單片機(jī)，功能如下：（1）采集信號(hào)，有16路A/D轉(zhuǎn)換功能，可產(chǎn)生8位、10位轉(zhuǎn)換結(jié)果，有40路I/O輸入輸出端口。（2）有8路PWM波形輸出端口。（3）有多個(gè)時(shí)鐘功能，總線頻率16MHZ。4、橫擺角和G傳感儀，能測(cè)量汽車(chē)的橫擺角、橫向和縱向加速度；5、電子尺式前輪轉(zhuǎn)角信號(hào)，等同于方向盤(pán)轉(zhuǎn)角信號(hào)； 6、4個(gè)輪速傳感器，供給單片機(jī)輪速信號(hào)，通過(guò)相關(guān)控制算法，得到車(chē)身狀態(tài)信息；7、12個(gè)制動(dòng)回路電磁閥，分別是4個(gè)車(chē)輪的制動(dòng)增壓、減壓電磁閥,2個(gè)隔離閥，2個(gè)吸入閥， 9、制動(dòng)泵。 3.2傳感器的選擇與電路設(shè)計(jì) 3.2.1輪速傳感器的選擇與電路設(shè)計(jì) 目前，測(cè)量車(chē)輪轉(zhuǎn)動(dòng)速度的一般方法是將變磁阻式磁電傳感器安裝在車(chē)輪總成的非旋轉(zhuǎn)部分上，與隨車(chē)輪一起轉(zhuǎn)動(dòng)的由導(dǎo)磁材料制成的齒圈相對(duì)。當(dāng)齒圈隨車(chē)輪一起轉(zhuǎn)動(dòng)時(shí)，由于齒圈與傳感器之間氣隙的的交替變化，導(dǎo)致兩者間磁阻的變化，從而在傳感器內(nèi)的線圈上感生出交變的電壓信號(hào)。 輪速傳感器是由永久磁鐵、磁極、線圈和齒圈組成。齒圈5在磁場(chǎng)中旋轉(zhuǎn)時(shí)，齒圈齒頂和電極之間的間隙就以一定的速度變化，則使磁路中的磁阻發(fā)生變化。其結(jié)果是使磁通量周期地增減，在線圈1的兩端產(chǎn)生正比于磁通量增減速度的感應(yīng)電壓，并將該交流電壓信號(hào)輸送給電子控制器。如下圖3.2 圖3.2 輪速傳感器結(jié)構(gòu)原理圖 1-線圈；2-磁鐵；3磁極；4-磁通；5-齒圈 當(dāng)齒圈的齒數(shù)一定時(shí)，傳感器信號(hào)的頻率只與車(chē)輪的轉(zhuǎn)速有關(guān)。因此，硬件系統(tǒng)的電控單元通常是經(jīng)過(guò)專(zhuān)門(mén)的信號(hào)處理電路將傳感器正弦波信號(hào)轉(zhuǎn)換為同頻率的方波信號(hào)，通過(guò)檢測(cè)方波信號(hào)的頻率或周期來(lái)計(jì)算車(chē)輪的轉(zhuǎn)速。 輪速傳感器信號(hào)處理電路圖如下： 圖3.3 輪速信號(hào)采集電路 6、7為信號(hào)輸出端口，接往單片機(jī)I/O口進(jìn)行信號(hào)采集。 輪速信號(hào)轉(zhuǎn)換流程如下圖3.3： 輪速傳感器 濾波電路 產(chǎn)生方波信號(hào) 單片機(jī) 圖3.4 輪速信號(hào)處理流程 為了提高測(cè)量輪速度精度，輪速信號(hào)處理電路應(yīng)具有如下功能： （1）將正弦波信號(hào)轉(zhuǎn)換為同頻率的方波信號(hào)時(shí)，方波的占空比應(yīng)當(dāng)適中； （2）由于振動(dòng)，氣隙在一定范圍內(nèi)變動(dòng)時(shí)，仍然能正確地進(jìn)行波形變換； （3）電磁兼容性好，能抑制噪聲干擾。 由以上信息得出，輪速傳感器基本可以滿足設(shè)計(jì)要求，可以選用該傳感器和信號(hào)處理電路。 3.2.2 方向盤(pán)轉(zhuǎn)角傳感器的選擇 在本設(shè)計(jì)當(dāng)中，使用電子尺測(cè)量轉(zhuǎn)向橫拉桿的位移測(cè)量，電子尺的采集信號(hào)為0-5V的電壓信號(hào)。 圖3.5 電子尺 由方向盤(pán)轉(zhuǎn)角信號(hào)輸出的信號(hào)時(shí)方波信號(hào)，通過(guò)集成電路信號(hào)處理端口，將方向盤(pán)信號(hào)-720°—+720°的信號(hào)轉(zhuǎn)換為0—5v電壓信號(hào)，當(dāng)信號(hào)為2.5v時(shí)，表征方向盤(pán)無(wú)轉(zhuǎn)角，電壓信號(hào)可以直接輸入到單片機(jī)的A/D端口，可隨時(shí)取讀電壓信號(hào)作為判斷方向盤(pán)的轉(zhuǎn)角信號(hào)，同時(shí)理想的認(rèn)為是前輪轉(zhuǎn)角信號(hào)。 側(cè)向范圍和側(cè)向精度均可以達(dá)到設(shè)計(jì)要求，因此可以選用電子尺代替方向轉(zhuǎn)角傳感器和前輪轉(zhuǎn)角傳感器。 3.2.3橫擺角和G傳感器總成的選擇 橫擺角和G傳感器總成包括橫擺角速度、縱向以及橫向加速度傳感器，輸出的信號(hào)都是0V-5V的模擬量，由于汽車(chē)顛簸造成的信號(hào)波動(dòng)特性一致，故封裝在同一模塊中。汽車(chē)運(yùn)行過(guò)程中，在較好路面上行駛時(shí)，信號(hào)較好，而在顛簸路面上行駛，故需要在軟件中設(shè)計(jì)數(shù)字濾波環(huán)節(jié)。數(shù)字濾波常用的有維納濾波器、卡爾曼濾波器、線性預(yù)測(cè)器、自適用濾波器等。在笨設(shè)計(jì)中，采用短時(shí)間連續(xù)取值求和，再取平均值的方法，來(lái)減少雜波和無(wú)效信號(hào)的干擾。硬件實(shí)物如下圖3.6： 圖3.6 BOSCH的橫擺角與G傳感儀 1-空；2-空；3-5V輸入電壓；4-橫擺角速度信號(hào)；5-橫向加速度信號(hào)；6-接地 3.3液壓電磁閥回路系統(tǒng) 3.3.1液壓控制單元結(jié)構(gòu) ECU 圖3.7 液壓控制單元結(jié)構(gòu) 3.3.2液壓電磁閥控制回路 14 15 11 9 5 7 8 10 6 12 13 4 2 1 3 北京現(xiàn)代ESP制動(dòng)回路圖 圖3.8 未制動(dòng)時(shí)管路電磁閥圖 如圖所示1為右吸入閥，2為左吸入閥，3為右隔離閥，4為左隔離閥，5為右吸入泵，6為左吸入泵，7為左后增壓閥，8為左后減壓閥，9為右前增壓閥，10為右前減壓閥，11為電機(jī)，12為左前增壓閥，13為左前減壓閥，14為右后增壓閥，15為右后減壓閥。 低壓回路 高壓回路 圖3.9 左轉(zhuǎn)彎轉(zhuǎn)向不足時(shí)ESP制動(dòng) 此時(shí)工作的電磁閥為右吸油電磁閥，右隔離電磁閥，右前增壓閥，左吸油閥，高壓油路為工作油路，低壓油路為回油油路，此時(shí)電機(jī)工作，帶動(dòng)左、右吸油泵工作。此時(shí)制動(dòng)的車(chē)輪為左后輪。 3.3.3驅(qū)動(dòng)電路的設(shè)計(jì) 對(duì)于驅(qū)動(dòng)電路的設(shè)計(jì)，需要電磁閥通過(guò)的最小電流為2A，ABS泵需要驅(qū)動(dòng)的電流為20A最小。同時(shí)要求12v大電流電路和控制信號(hào)電路之間有良好的隔離效果。 信號(hào)輸出為單片機(jī)PWM信號(hào)，電壓范圍0—5V，電流極小，不超過(guò)25mA，控制ESP電磁閥工作的是開(kāi)關(guān)電路。在設(shè)計(jì)電路時(shí)，選用光耦P521作為信號(hào)隔離元件，選用IRFP250作為大電流承擔(dān)元件，IRFP引腳如圖3.11，分別為G、D、S，當(dāng)保持Ugs為10V時(shí)，IRFP250可通過(guò)最大電流為22A。 光耦一般由三部分組成：光的發(fā)射、光的接收及信號(hào)放大。輸入的電信號(hào)驅(qū)動(dòng)發(fā)光二極管（LED），使之發(fā)出一定波長(zhǎng)的光，被光探測(cè)器接收而產(chǎn)生光電流，再經(jīng)過(guò)進(jìn)一步放大后輸出。這就完成了電—光—電的轉(zhuǎn)換，從而起到輸入、輸出、隔離的作用。由于光耦合器輸入輸出間互相隔離，電信號(hào)傳輸具有單向性等特點(diǎn)，因而具有良好的電絕緣能力和抗干擾能力。又由于光耦合器的輸入端屬于電流型工作的低阻元件，因而具有很強(qiáng)的共模抑制能力。 光耦結(jié)構(gòu)原理如下圖3.10,1H為信號(hào)輸入高電壓端口，2L為信號(hào)輸入的地電位端口，3H為信號(hào)輸出的高電位端口，4L為信號(hào)輸出的地電位端口。信號(hào)電流由1H流向2L，發(fā)光二極管發(fā)光，產(chǎn)生的光信號(hào)，激發(fā)光敏三極管，使3H和4L之間單向?qū)ā? 圖3.10 光耦原理圖 3.3.4驅(qū)動(dòng)電路圖 對(duì)于驅(qū)動(dòng)回路，由于有帶鐵芯的電感線圈，因此在高頻斷電的時(shí)候，會(huì)產(chǎn)生高壓感應(yīng)電動(dòng)勢(shì)，因此在斷電的時(shí)候，必須給電磁閥回路短路處理，消耗掉線圈的感應(yīng)電流，在初期制作電路板的時(shí)候，由于沒(méi)有短路回路，繼電器直接就被高壓電火花吸引而不斷開(kāi)，或者直接被擊穿了。因此在電路改進(jìn)的過(guò)程中，將繼電器換成了汽車(chē)上常用的三極管IRFP250，在Ugs=10V的時(shí)候能經(jīng)受最大電流為22A,為了防止長(zhǎng)時(shí)間工作導(dǎo)致三極管溫度上升，在三極管上安裝了散熱裝置。在三極管D端口和12V之間，制作一個(gè)單向回路，用單相管IN4007隔斷，IN4007的擊穿電壓高達(dá)1000V,工作電流為1A，在IN4007后串聯(lián)的是主要的耗能電阻100Ω/1W，可經(jīng)受住30A電流沖擊。由以上措施，確保了在光耦回路斷電后，電磁閥的感應(yīng)電流和電壓不干擾三極管的工作，而直接消耗在由電磁閥—電阻—電磁閥的這個(gè)循環(huán)回路，由于電磁閥的電阻小，因此只承擔(dān)了很小的一部分能量的消耗。如下圖3.11 圖3.11 電路圖局部視圖 3.4飛思卡爾MC9S12XS128單片機(jī) 本文中采用Freescale MC9S12XSl28B單片機(jī)作為汽車(chē)穩(wěn)定性控制器的主控制單元，F(xiàn)reescale單片機(jī)在汽車(chē)電子領(lǐng)域應(yīng)用的非常廣泛。MC9S12XSl28是以CPUl2為核心的單片機(jī)，其CPU芯片內(nèi)部頻率為16MHz，有128Kb的ROM，采用5V電壓供電，輸入輸出引腳的電壓為5V。（附單片機(jī)電路圖） 單片機(jī)外圍功能模塊如下： （1）串行外接設(shè)備（SPI）； （2）串行通信設(shè)備（SCI）； （3）總線接口； （4）增強(qiáng)型捕捉定時(shí)器（ECT）； （5）模數(shù)轉(zhuǎn)換器（ATD）； （6）脈寬調(diào)制模塊（PWM）； （7）CAN控制器。 3.4.1飛思卡爾S12芯片A/D轉(zhuǎn)化模塊特點(diǎn)： 8/10 位精度；7 us, 10-位單次轉(zhuǎn)換時(shí)間.；采樣緩沖放大器；可編程采樣時(shí)間； 左/右對(duì)齊, 有符號(hào)/無(wú)符號(hào)結(jié)果數(shù)據(jù)；外部觸發(fā)控制；轉(zhuǎn)換完成中斷；模擬輸入 8 通道復(fù)用；模擬/數(shù)字輸入引腳復(fù)用；1 到 8 轉(zhuǎn)換序列長(zhǎng)度；連續(xù)轉(zhuǎn)換模式；多通 道掃描方式。 ATD 模塊有模擬量前端、模擬量轉(zhuǎn)換、控制部分及結(jié)果存儲(chǔ)等四部分組成。其中模擬前端包括多路轉(zhuǎn)換開(kāi)關(guān)、采樣緩沖器、放大器等，結(jié)果存儲(chǔ)部分主要有8個(gè) 16 位的存儲(chǔ)器和反映工作狀態(tài)的若干標(biāo)志位。 飛思卡爾S12單片機(jī)的PWM 調(diào)制波有 8 個(gè)輸出通道，每一個(gè)輸出通道都可以獨(dú)立的進(jìn)行輸出。每 一個(gè)輸出通道都有一個(gè)精確的計(jì)數(shù)器（計(jì)算脈沖的個(gè)數(shù)），一個(gè)周期控制寄存器 和兩個(gè)可供選擇的時(shí)鐘源。每一個(gè) PWM 輸出通道都能調(diào)制出占空比從 0—100% 變化的波形。 3.4.2 PWM的主要特點(diǎn) 1、它有 8 個(gè)獨(dú)立的輸出通道，并且通過(guò)編程可控制其輸出波形的周期。 2、每一個(gè)輸出通道都有一個(gè)精確的計(jì)數(shù)器。 3、每一個(gè)通道的 PWM 輸出使能都可以由編程來(lái)控制。 4、PWM 輸出波形的翻轉(zhuǎn)控制可以通過(guò)編程來(lái)實(shí)現(xiàn)。 5、周期和脈寬可以被雙緩沖。當(dāng)通道關(guān)閉或 PWM 計(jì)數(shù)器為 0 時(shí)，改變周期和脈寬才起作用。 6、8 字節(jié)或 16 字節(jié)的通道協(xié)議。 7、有 4 個(gè)時(shí)鐘源可供選擇（A、SA、B、SB），他們提供了一個(gè)寬范圍的時(shí) 鐘頻率。 8、通過(guò)編程可以實(shí)現(xiàn)希望的時(shí)鐘周期。 9、具有遇到緊急情況關(guān)閉程序的功能。 10、每一個(gè)通道都可以通過(guò)編程實(shí)現(xiàn)左對(duì)齊輸出還是居中對(duì)齊輸出。 PWM寄存器的設(shè)置 （1）禁止PWM PWME = 0 （2）選擇時(shí)鐘 PWMPRCLK，PWMSCLA，PWMSCLB，PWMCLK （3）選擇極性 PWMPOL （4）選擇對(duì)齊方式 PWMCAE （5）選擇占空比和周期PWMDTYx，PWMPERx （6）使能PWM PWME = 1 3.5 本章小結(jié) 本章主要介紹了控制器的硬件部分的選擇和結(jié)構(gòu)原理，控制器的硬件部分包括信號(hào)輸入部分，信號(hào)處理部分和執(zhí)行器三部分，還介紹了自主設(shè)計(jì)和制作的電路。 第4章 軟件設(shè)計(jì) 4.1 軟件設(shè)計(jì)總體思路 汽車(chē)側(cè)向穩(wěn)定性控制系統(tǒng)，根據(jù)采集到的各種數(shù)據(jù)，通過(guò)加速度的計(jì)算，確定汽車(chē)是否處于主動(dòng)減少狀態(tài)，決定是否經(jīng)行制動(dòng)控制，通過(guò)滑移率的計(jì)算，確定車(chē)輪是否處于最大滑移率范圍內(nèi)，通過(guò)控制相應(yīng)的電磁閥的開(kāi)啟和閉合，達(dá)到最優(yōu)制動(dòng)的結(jié)果。通過(guò)一定的算法計(jì)算出橫擺角速度的大小與實(shí)際測(cè)量的大小相比較，得出汽車(chē)目前穩(wěn)定的狀態(tài)，通過(guò)控制算法，對(duì)相應(yīng)的車(chē)輪做制動(dòng)，減輕橫擺角的進(jìn)一步增大，通過(guò)PWM波輸出，控制增壓、減壓電磁閥的開(kāi)啟和閉合，達(dá)到穩(wěn)定性的控制。本系統(tǒng)的軟件設(shè)計(jì)主要包括各模塊初始化、主程序設(shè)計(jì)、A/D轉(zhuǎn)換模塊程序設(shè)計(jì)、PWM驅(qū)動(dòng)模塊程序設(shè)定、串口程序設(shè)定等。在本次設(shè)計(jì)中主要應(yīng)用單片機(jī)飛思卡爾MC9S12XS128的模塊有A/D,PWM，定時(shí)模塊，I/O模塊等。 引用頭文件 定義全局變量 設(shè)定A/D信號(hào)采集 設(shè)定PWM信號(hào)輸出 設(shè)定時(shí)鐘模塊 設(shè)定輪速信號(hào)采集 設(shè)定橫擺穩(wěn)定性控制 主程序 初始化各模塊 取讀輸入信號(hào) 穩(wěn)定性判斷 輸出控制 延時(shí) 圖4.1 總體流程圖 圖解：（1）全局變量為所有程序公用的信息，如車(chē)速信號(hào)，制動(dòng)壓力信號(hào)，加速度信號(hào)等；（2）A/D采集信號(hào)包括電子尺轉(zhuǎn)向信號(hào)、橫擺角速度信號(hào)、側(cè)向加速度、縱向加速度信號(hào)、制動(dòng)回路壓力信號(hào)；（3）PWM波形輸出控制，設(shè)定波形周期，占空比在實(shí)際使用的是設(shè)置。（4）輪速采集信號(hào)使用的I/O串口，制動(dòng)主缸增壓電機(jī)由I/O控制輸出。 設(shè)置橫擺穩(wěn)定性控制器的控制周期為0.1s,即100ms，因此設(shè)置PWM的周期也為100ms,只需要控制PWM的占空比，也就可以控制一個(gè)周期內(nèi)電磁閥的開(kāi)啟時(shí)間，方便設(shè)置改變和控制。 4.2方向盤(pán)轉(zhuǎn)角（前輪轉(zhuǎn)角）信號(hào)的采集 在試驗(yàn)車(chē)上，安裝的是電子尺，用于測(cè)量轉(zhuǎn)向橫拉桿的橫向位移量，將位移量轉(zhuǎn)化為前輪轉(zhuǎn)角，這個(gè)值比方向盤(pán)轉(zhuǎn)角信號(hào)來(lái)的準(zhǔn)確。電子尺的工作行程為200mm，轉(zhuǎn)向橫拉桿的極限行程為150mm,因此將0-5v等效為0-200mm，5v/200mm=0.025v/mm,即25mv/mm,選用10位A/D轉(zhuǎn)換精度，精度為4.8mv，因此可以測(cè)量到0.2mm。 定義無(wú)轉(zhuǎn)向信號(hào)的時(shí)候，信號(hào)輸出為2.5v，電子尺的位移為100mm,試驗(yàn)車(chē)的橫向拉桿的實(shí)際位移量為150mm，因此采集的有效信號(hào)范圍是0.625-4.375v,將此范圍的電壓信號(hào)轉(zhuǎn)換為車(chē)輪的轉(zhuǎn)角信號(hào)。車(chē)輪的轉(zhuǎn)角信號(hào)范圍是負(fù)30°到正30°，即3.75v/60°=0.0625v/°=62.5mv/°，精度足夠高，滿足使用要求。 由以上換算得到角度和電壓的關(guān)系=,假設(shè)向左轉(zhuǎn)為正，向右轉(zhuǎn)為負(fù)。 4.3橫擺角信號(hào)與側(cè)向加速度信號(hào)的采集 橫向加速度信號(hào)，橫擺角速度信號(hào)以及電子尺的信號(hào)均為電壓信號(hào)，而且為0-5v電壓，因此采用A/D轉(zhuǎn)換，可得到比較精確的結(jié)果。 A/D寄存器設(shè)置如下： void ATD_Init(void) //8bit模式 { ATD0CTL2=0x42; //禁止外部觸發(fā) ATD0CTL3=0xc0; //7:1數(shù)據(jù)右對(duì)齊無(wú)符號(hào),每次轉(zhuǎn)換8個(gè)序列, No FIFO, Freeze模式下繼續(xù)轉(zhuǎn) ATD0CTL4=0x17; //765: 采 樣 時(shí) 間 為 4 個(gè) AD 時(shí) 鐘 周期,ATDClock=[BusClock*0.5]/[PRS+1]=1MHz(BusClock=16MHz) ATD0CTL5=0x30; //6:0 特殊通道禁止,5:1 連續(xù)轉(zhuǎn)換 0 單次轉(zhuǎn)換 ,4:1 多通道輪流采樣567: ATD0DIEN=0x00; //輸入允許寄存器 } 4.4 輪速信號(hào)采集 本設(shè)計(jì)采用頻率法采集輪速，原理如下：在單位周期內(nèi)，計(jì)算累計(jì)脈沖的個(gè)數(shù)，然后經(jīng)行計(jì)算，輪速脈沖經(jīng)過(guò)引號(hào)處理后為標(biāo)準(zhǔn)的脈沖。 輪速脈沖 采樣周期 圖4-2 頻率法計(jì)算輪速周期原理圖 輪速信號(hào)的頻率計(jì)算公式4.1： （4.1） 輪速計(jì)算公式為： （4.2） 其中：r為車(chē)輪半徑；ψ為一個(gè)測(cè)量周期的脈沖數(shù)；Z為輪速傳感器齒圈的齒數(shù)，Z=43；T為采樣周期。 以下為輪速信號(hào)采集的相關(guān)寄存器的設(shè)置： //通道0輸入捕捉初始化 void ECT0_Init(void) { TSCR2=0X06; //禁止溢出中斷，分頻系數(shù)為64（24/64MHZ） TIOS_IOS0=0;// 通道0為輸入捕捉 TCTL4=0X01; //捕捉為上升沿 TIE_C0I=1 ; //允許0通道輸入捕捉 TSCR1=0X80;//時(shí)能定時(shí)器 } //定時(shí)器0輸入捕捉中斷 #pragma CODE_SEG __NEAR_SEG NON_BANKED void interrupt 8 Timer0_Onput(void) { TFLG1_C0F=1 ;//清中斷標(biāo)志 Input_Num++; PORTB=~Input_Num; if(Input_Num>=255) { Input_Num=0; } } 輪速控制范圍假設(shè)為5m/s到30m/s，則輪速信號(hào)頻率范圍是136Hz到820Hz,設(shè)定采樣周期為50ms,則在車(chē)速最低的時(shí)候，每個(gè)周期采集的輪速信號(hào)6個(gè)脈沖，有實(shí)際意義。將采集的輪速信號(hào)，相加取平均值作為車(chē)速信號(hào)。 4.5 PWM寄存器設(shè)置 PWM設(shè)置如下： void PWM_Init(void) { PWME=0x00; //禁止 PWMPRCLK=0x77; //時(shí)鐘預(yù)分頻A=B=16M/128=125K PWMSCLA=125; //SA=A/2/125=500HZ PWMSCLB=125; //SB=B/2/125=500HZ PWMCTL=0x00; //控制寄存器設(shè)置 PWMCLK=0xff; //時(shí)鐘寄存器為SB PWMPOL=0xff; //Duty=High Time 極性設(shè)置 1,高電平輸出 PWMCAE=0x00; // left-aligned 左對(duì)齊方式 PWMPER0=50; //Frequency=SB/50=10Hz 周期寄存器設(shè)置 PWMPER1=50; PWMPER2=50; PWMPER3=50; PWMPER4=50; PWMPER5=50; PWMPER6=50; PWMPER7=50; } 4.6判斷穩(wěn)定系控制程序的編寫(xiě) 取讀輸入信號(hào) 控制方法 判斷控制車(chē)輪 控制輸出 延時(shí)控制 返回 圖4-3 控制流程圖 等待信號(hào)輸入轉(zhuǎn)換完成程序如下： while(!ATD0STAT2_CCF5); sum[4]=ATD0DR5L; while(!ATD0STAT2_CCF5); sum[5]=ATD0DR5L; while(!ATD0STAT2_CCF6); sum[6]=ATD0DR6L; while(!ATD0STAT2_CCF7); sum[7]=ATD0DR7L; ATD0STAT0_SCF=1; while(!ATD0STAT0_SCF); //轉(zhuǎn)換4，5，6，7通道數(shù)據(jù) 將數(shù)據(jù)換算賦值給相應(yīng)的變量： cs=sum[4]/20.48; hx=sum[7]/20.48; // sum[7]橫向加速度，m/s2。加速度范圍[-25m/s2到25m/s2] hb=sum[6]/20.48; fx=sum[5]/17.07; 其中：cs-車(chē)速；hx-橫向加速度；hb-橫擺角速度；fx-方向轉(zhuǎn)角。 將數(shù)據(jù)換算成最終比較值，程序代碼如下： hbc=hb-cs/(1+cs*cs*0.003)*fx; zxcp0=cs*10/0hx-zxcp1*10; zxcp1=cs*10/hx; 其中hbc是橫擺角速度差值，zxcp0是質(zhì)心側(cè)偏角速度，zxcp1是質(zhì)心側(cè)偏角。 下表是根據(jù)液壓制動(dòng)管路圖3.8和控制策略表2.1得出下表。 表4.1 車(chē)輪制動(dòng)時(shí)各電磁閥導(dǎo)通和截止?fàn)顟B(tài) 制動(dòng)輪 右吸入 左吸入 右隔離 左隔離 左前增 右前增 左后增 右后增 代碼 左后輪 導(dǎo)通 導(dǎo)通 截止 導(dǎo)通 截止 截止 導(dǎo)通 截止 ed 右前輪 導(dǎo)通 導(dǎo)通 截止 導(dǎo)通 截止 導(dǎo)通 截止 截止 eb 左前輪 導(dǎo)通 導(dǎo)通 導(dǎo)通 截止 導(dǎo)通 截止 截止 截止 d7 右后輪 導(dǎo)通 導(dǎo)通 導(dǎo)通 截止 截止 截止 截止 導(dǎo)通 de 右前后 左后 導(dǎo)通 導(dǎo)通 截止 截止 截止 導(dǎo)通 導(dǎo)通 導(dǎo)通 f8 右前后 導(dǎo)通 導(dǎo)通 截止 截止 截止 導(dǎo)通 截止 導(dǎo)通 fa 左前后 導(dǎo)通 導(dǎo)通 截止 截止 導(dǎo)通 截止 導(dǎo)通 截止 f5 右前 左前后 導(dǎo)通 導(dǎo)通 截止 截止 導(dǎo)通 導(dǎo)通 導(dǎo)通 截止 f1 右前后 左前 導(dǎo)通 導(dǎo)通 截止 截止 導(dǎo)通 導(dǎo)通 截止 導(dǎo)通 f2 右后 左前后 導(dǎo)通 導(dǎo)通 截止 截止 導(dǎo)通 截止 導(dǎo)通 導(dǎo)通 f4 四輪制動(dòng) 導(dǎo)通 導(dǎo)通 截止 截止 導(dǎo)通 導(dǎo)通 導(dǎo)通 導(dǎo)通 f0 具體控制程序如下： if(fx<0) { if(hbc>30&&zxcp1>12) //轉(zhuǎn)向過(guò)多 { PWME=0xf2; //(1111 0010) 參照制動(dòng)表查看 } else if(hbc>30&&zxcp1<-12) { PWME=0xfa; //(1111 1010) } else if(hbc<30&&hbc>-30&&zxcp1>12) { PWME=0xf7; //(1111 0111) } else if(hbc<30&&hbc>-30&&zxcp1<-12) { PWME=0xee; //(1110 1110) } else if(hbc<-30&&zxcp1>12) //轉(zhuǎn)向不足 { PWME=0xf5; } //(1111 0101) else if(hbc<-30&&zxcp1<-12) { PWME=0xfb; //(1111 1011) } } else if(fx>0) //向zuo轉(zhuǎn)彎 { if(hbc>30&&zxcp1>=12) //轉(zhuǎn)向過(guò)多 { PWME=0xf2; //(1111 0010) } else if(hbc>30&&zxcp1<-12) { PWME=0xfa; //(1111 1010) } else if(hbc<30&&hbc>-30&&zxcp1>12) { PWME=0xe7; //(1110 0111) } else if(hbc<30&&hbc>-30&&zxcp1<-12) { PWME=0xeb; //(1110 1011) } else if(hbc<=-30&&zxcp1>=12)