黃 珍 吳浩然 庫(kù) 峰 徐小強(qiáng)
(武漢理工大學(xué)自動(dòng)化學(xué)院 武漢 430033)
車輛自適應(yīng)巡航控制系統(tǒng)(adaptive cruise control,ACC)是智能交通系統(tǒng)(ITS)領(lǐng)域中先進(jìn)車輛控制及安全系統(tǒng)(AVCSS)開發(fā)的一個(gè)重要方面.ACC是在傳統(tǒng)巡航控制技術(shù)基礎(chǔ)上發(fā)展起來的,因此既具有傳統(tǒng)巡航控制的定速巡航能力,同時(shí)可通過雷達(dá)等車載傳感器采集信息,自動(dòng)調(diào)整車輛行駛速度,保持本車與前行車輛的安全間距,從而降低駕駛員操作量、減輕駕駛疲勞,提高車輛的主動(dòng)安全性及駕駛舒適性.
國(guó)內(nèi)外對(duì)ACC 系統(tǒng)的研究主要集中在車載傳感器技術(shù)、信息融合技術(shù)以及控制策略選取等軟硬件技術(shù)上.其中如何選取控制策略是實(shí)現(xiàn)ACC 系統(tǒng)功能的關(guān)鍵技術(shù).目前,國(guó)內(nèi)外車輛ACC的典型控制算法主要有分工況控制和分層控制兩種.分工況控制算法將控制工況分為驅(qū)動(dòng)控制與制動(dòng)控制[1]、速度控制與距離控制[2],或分為定速與跟車[3]等多種工況分別進(jìn)行控制.分層控制,即上層控制器依據(jù)傳感器采集到的車距和相對(duì)速度,以及駕駛員設(shè)定的車輛時(shí)距和巡航速度來決定車輛的縱向加速度.下層控制器依據(jù)上層控制器計(jì)算出的車輛期望加速度對(duì)剎車和油門進(jìn)行控制,從而使車輛保持設(shè)定車速或車距.
其中,分工況控制一般針對(duì)不同的控制工況采用特定的控制模型,當(dāng)多個(gè)工況間相互切換時(shí),控制狀態(tài)變量存在間斷不連續(xù)等問題,影響了控制效果.分層控制不存在工況間的切換,避免了這個(gè)問題.但是,分層控制算法在實(shí)際運(yùn)用上也存在困難.首先,現(xiàn)有的大部分傳感器(如激光雷達(dá)、微波雷達(dá)、毫米波雷達(dá)等)只能測(cè)量相對(duì)距離和前、自車速度,而無法直接測(cè)得加速度.因此,前、自車加速度只能通過間接方法(如速度值對(duì)時(shí)間求微分)求得,這樣不僅引入了額外的計(jì)算誤差,某些情況下(如速度曲線在某一點(diǎn)不可微)系統(tǒng)甚至?xí)霈F(xiàn)不可預(yù)知的錯(cuò)誤.其次,現(xiàn)有的上層控制器所采用的算法如線性最優(yōu)控制[4]、線性二次型最優(yōu)控制(LQ)、時(shí)間能量最小最優(yōu)控制(TEM)以及LQ 和TEM 的混合算法[5]等,這些算法普遍較復(fù)雜,系統(tǒng)運(yùn)算量較大,對(duì)系統(tǒng)運(yùn)算能力需求較高,因此增加了技術(shù)難度和成本.
針對(duì)上述問題,筆者在分層控制的基礎(chǔ)上,提出了一種根據(jù)當(dāng)前車距以及前、自車車速,基于安全、舒適因素綜合因素決策車輛期望速度,從而控制車輛的車距和車速的ACC 控制算法.該算法將傳統(tǒng)ACC控制系統(tǒng)中求取期望加速度改為決策期望車速,有效減少了系統(tǒng)運(yùn)算量,提高了系統(tǒng)響應(yīng)速度.
作者構(gòu)建的ACC 控制系統(tǒng)以車輛直線行駛為主,考慮到尊重駕駛員的駕駛習(xí)慣以及安全因素,系統(tǒng)將不控制車輛主動(dòng)變換行駛車道.
將車輛運(yùn)行狀態(tài)分為2種工作模式:
1)定速巡航模式 當(dāng)前方無車或車距大于設(shè)定值時(shí),系統(tǒng)工作在該模式,系統(tǒng)根據(jù)用戶設(shè)定的目標(biāo)車速定速行駛.
2)安全跟車模式 當(dāng)與前方車輛的車距小于等于設(shè)定值時(shí),系統(tǒng)進(jìn)入跟車模式.車輛首先調(diào)整車速使車距達(dá)到設(shè)定值.若前車車速大于用戶設(shè)定的巡航車速,則進(jìn)入定速巡航模式;若前車車速小于等于用戶設(shè)定的巡航車速,則車輛保持與前車相同的車速行駛,使車距穩(wěn)定在設(shè)定值.
車速控制器共有5個(gè)輸入?yún)⒘浚?個(gè)傳感器采集量(前/自車車速、當(dāng)前車距)和兩個(gè)用戶設(shè)定值(目標(biāo)巡航車速、目標(biāo)車距).控制器的輸出為節(jié)氣門開度和剎車力矩.
按照分層控制的思想,將控制器分解為2層.(1)上層控制器輸入量為:前車車速、當(dāng)前車距、目標(biāo)巡航車速、目標(biāo)車距,輸出為自車期望車速.(2)下層控制器根據(jù)上層算法提供的期望車速和當(dāng)前的自車車速,輸出節(jié)氣門開度和剎車力矩值,從而控制車速.控制器結(jié)構(gòu)見圖1.
圖1 車速自適應(yīng)控制器結(jié)構(gòu)示意圖
上層控制器首先根據(jù)傳感器采集信息和用戶設(shè)定值判斷當(dāng)前工作模式,輸出為車輛當(dāng)前的期望車速.若為定速巡航模式,則直接輸出用戶設(shè)定巡航車速作為當(dāng)前期望車速;若為跟車模式,則需通過車距控制算法計(jì)算出當(dāng)前期望車速.
目前國(guó)內(nèi)外的車距控制算法有線性最優(yōu)控制、LQ&TEM、神經(jīng)網(wǎng)絡(luò)控制[6]以及滑??刂疲?]等,這些算法結(jié)構(gòu)較復(fù)雜,計(jì)算量大,具體實(shí)現(xiàn)難度較大.因此,這里探尋出一種更為簡(jiǎn)單的車距控制算法.
因?yàn)橐3周嚲嗖蛔?,所以在車距穩(wěn)定時(shí),自車與前車車速必然相等.因此,可以前車車速為依據(jù),使自車車速以某種規(guī)律趨近于前車車速.綜合考慮安全、駕駛舒適性等因素,建立理想車速規(guī)律表.
設(shè)當(dāng)前實(shí)際車距為d,目標(biāo)車距為ddes,前車車速為vq,設(shè)定巡航車速為vs,自車車速為v,當(dāng)前期望車速為vdes,車距模塊輸出期望車速為vcj.
計(jì)算車距誤差Δd,即
將Δd 的取值范圍分成n 個(gè)區(qū)間(L1,L2,L3,…,Ln),每個(gè)區(qū)間對(duì)應(yīng)一個(gè)系數(shù)k值,當(dāng)前時(shí)刻的期望車速.即
系數(shù)k=(k1,k2,k3,…,kn)的取值規(guī)律是隨著Δd 的由負(fù)到正k 先由一個(gè)0到1之間的值逐漸增大到1,再逐漸增大.取值舉例見表1.
表1 系數(shù)k、區(qū)間L、Δd與vcj的關(guān)系表
而上層控制器的輸出vdes則由vcj與vs比較后的較小值決定,即
下層控制器相當(dāng)于一個(gè)定速巡航控制器,即控制器與被控車輛形成閉環(huán),使車輛按照期望車速行駛.
下層控制器根據(jù)加速和減速兩種情況,將節(jié)氣門控制和剎車控制獨(dú)立設(shè)計(jì),通過切換邏輯使它們分別作用于車輛.
2.2.1 節(jié)氣門控制
節(jié)氣門控制采用PID 算法,考慮到不同期望車速之間的平穩(wěn)切換,可采用增量式PID 控制,如式(4)和(5)所示.
式中:Δu(kT)為第k次采樣時(shí)刻控制器輸出值的增量;Kp為比例系數(shù);Ki為積分系數(shù);Kd為微分系數(shù);vdes(kT)為當(dāng)前期望車速;v(kT)為自車第k次采樣時(shí)刻的實(shí)際車速;T 為采樣周期.
2.2.2 剎車控制
根據(jù)ACC控制原理,ACC 控制器在剎車方面主要有以下2個(gè)特點(diǎn):(1)為了保證乘坐的舒適性,并且系統(tǒng)不會(huì)產(chǎn)生讓駕駛員感到驚奇的行為,汽車的剎車減速度應(yīng)小于2.5 m/s2;(2)要求剎車控制算法簡(jiǎn)單、精度高,且響應(yīng)迅速.
基于以上特點(diǎn),本系統(tǒng)將制動(dòng)力矩作為剎車控制的輸出值,在已知實(shí)際車輛每個(gè)車輪制動(dòng)壓力和制動(dòng)力矩轉(zhuǎn)換系數(shù)的前提下,可以方便地將系統(tǒng)的輸出值轉(zhuǎn)換為制動(dòng)力,由車輛的ABS 和EBD 系統(tǒng)分配給每個(gè)車輪.
根據(jù)剎車前實(shí)際車速與期望車速的差值Δv,系統(tǒng)將制動(dòng)力矩分檔輸出,剎車力矩的每一檔對(duì)應(yīng)Δv的一段取值區(qū)間,Δv 越大,對(duì)應(yīng)的制動(dòng)力矩越大.同時(shí),保證最大制動(dòng)力矩對(duì)應(yīng)的剎車減速度應(yīng)小于2.5m/s2.如遇到緊急情況需要更大制動(dòng)力矩時(shí),系統(tǒng)發(fā)出警報(bào)提醒駕駛員介入剎車.分檔剎車效果如圖2所示.
圖2 分檔剎車效果圖
2.2.3 節(jié)氣門、剎車控制的切換
在實(shí)際車輛控制中,油門和剎車是分時(shí)作用的,當(dāng)節(jié)氣門開度非最小值時(shí)制動(dòng)力矩應(yīng)為0,而當(dāng)制動(dòng)力矩不為0時(shí),節(jié)氣門開度應(yīng)為最小值.因此,控制好它們之間的切換尤為重要.
本系統(tǒng)將當(dāng)前期望車速vdes乘以一個(gè)大于1的系數(shù)p,再與自車車速v求差值,以此作為節(jié)氣門、剎車控制的切換規(guī)則,如表2.
表2 節(jié)氣門、剎車控制的切換規(guī)則
本算法在MATLAB-R2009a環(huán)境下建立了仿真模型,整個(gè)系統(tǒng)通過Matlab/Simulink實(shí)現(xiàn),包括四速自動(dòng)檔車輛縱向動(dòng)力學(xué)模型、控制器模型和傳感器信號(hào)模型等.車輛縱向動(dòng)力學(xué)模型根據(jù)文獻(xiàn)[8]提供的方法,以一款1.5L,72kW 自動(dòng)檔轎車為藍(lán)本構(gòu)建,其中發(fā)動(dòng)機(jī)模型、液力耦合器模型及車輛驅(qū)動(dòng)系模型利用Matlab/Simulink框圖實(shí)現(xiàn),自動(dòng)變速器模型利用Matlab/Stateflow 實(shí)現(xiàn).仿真系統(tǒng)結(jié)構(gòu)見圖3.
圖3 仿真系統(tǒng)結(jié)構(gòu)圖
為了驗(yàn)證控制器的控制效果,設(shè)置了三種前、自車行駛情景進(jìn)行模擬仿真.
用戶設(shè)定值:所有情景中,自車定速巡航速度始終設(shè)定為120km/h,目標(biāo)車距始終設(shè)定為80m.
仿真情景1 前車勻速.
在0~40s時(shí)前方無車,本車行駛在定速巡航模式,巡航車速為120km/h.在40s時(shí),前方60m 處發(fā)現(xiàn)速度為100km/h的前車,本車進(jìn)入跟車模式.仿真結(jié)果見圖4、圖5.
仿真情景2 前車變速(不大于巡航目標(biāo)車速).
在0~40s時(shí)前方無車,本車行駛在定速巡航模式,巡航車速為120km/h.在40s時(shí),前方60m 處發(fā)現(xiàn)速度為100km/h的前車,本車進(jìn)入跟車模式.在80s時(shí),前車加速到110km/h,在180s時(shí),前車減速到90km/h.仿真結(jié)果見圖6、圖7.
圖4 情景1時(shí)車距變化曲線
圖5 情景1時(shí)前方車輛與本車速度變化曲線
圖6 情景2時(shí)車距變化曲線
圖7 情景2時(shí)前方車輛與本車速度變化曲線
仿真情景3:前車變速(有時(shí)高于巡航目標(biāo)車速)
在0~40s時(shí)前方無車,本車行駛在定速巡航模式,巡航車速為120km/h.在40s時(shí),前方60m 處發(fā)現(xiàn)速度為100km/h的前車,本車進(jìn)入跟車模式.在80s時(shí),前車加速到130km/h,此時(shí)前車車速大于設(shè)定的巡航速度且車距不小于設(shè)定車距,本車進(jìn)入定速巡航模式.在120s時(shí),前車減速到90km/h,此時(shí)車距大于設(shè)定值,本車仍然定速巡航,當(dāng)車距縮小到設(shè)定值附近時(shí),本車進(jìn)入跟車模式.仿真結(jié)果見圖8、圖9.
圖8 情景3時(shí)車距變化曲線
圖9 情景3時(shí)前方車輛與本車速度變化曲線
從以上仿真結(jié)果可以看出,本車能較快跟隨前車,車距控制效果穩(wěn)定,調(diào)整時(shí)間短,速度響應(yīng)曲線能很好地滿足控制的需要.
三種情景下,定速模式車速控制穩(wěn)態(tài)誤差在0.02km/h以內(nèi),超調(diào)量小于0.6%;跟車模式車距穩(wěn)態(tài)誤差在0.15 m 以內(nèi),超調(diào)量小于1.8%.自動(dòng)剎車的最大減速度控制在2.5m/s2以內(nèi),根據(jù)研究,該減速度能很好地保證乘坐的舒適性.
在車速跟蹤及PID 控制的基礎(chǔ)上建立了車輛ACC分層控制算法.多種工況的仿真結(jié)果表明,該算法以較小的數(shù)據(jù)量和計(jì)算量獲得了較好的響應(yīng)速度和控制精度,有效地實(shí)現(xiàn)了車輛ACC系統(tǒng)的控制目標(biāo).本系統(tǒng)在加、減速度上還綜合考慮了乘客的舒適度.
下一步研究工作中,將從人性化決策以及節(jié)能的角度進(jìn)一步優(yōu)化算法,建立功能更加全面的智能車輛自適應(yīng)巡航控制系統(tǒng).
[1]IOANNOU P,XU Z.Throttle and brake control systems for automatic vehicle following[R].California PATH Research Paper,UCB-ITS-PRR-94-10,1994.
[2]YI Kyongsu,HONG Jinho,YOUNG Dokwon.A vehicle control algorithm for stop-and-go cruise control[J].Proceedings of the Institution of Mechanical Engineers,2001,215:122-128.
[3] WALTER J.Adaptive cruise control for coaches[C]//AVEC′96International Symposium on Advanced Vehicle Control at the Aachen University of Technology,1996.
[4]YI Kyongsu,YOUNG Dokwon.Vehicle-to-vehicle distance and speed control using an electronic-vacuum booster[J].JSAE Review,2001,22:403-412.
[5]LI Keqiang,GAO Feng,ZHENG Sifa,et al.A longitudinal control algorithm of upper layer controller design for automotive vehicles[C]//6th Int′l Symposium on Advanced Vehicle Control,2002:168-176.
[6]張浩然,王 煒,任 剛.基于相關(guān)分析的跟馳模型及其穩(wěn)定性[J].武漢理工大學(xué)學(xué)報(bào):交通科學(xué)與工程版,2008,32(4):581-584.
[7]李以農(nóng),冀 杰,鄭 玲,等.智能車輛自適應(yīng)巡航控制系統(tǒng)建模與仿真[J].中國(guó)機(jī)械工程,2010,21(11):1374-1381.
[8]侯德藻,高 鋒,李克強(qiáng),等.應(yīng)用于汽車主動(dòng)避撞系統(tǒng)的車輛縱向動(dòng)力學(xué)模型[J].清華大學(xué)學(xué)報(bào):自然科學(xué)版,2004,44(2):258-261.