陳欣宇,錢立軍,王其東
(合肥工業(yè)大學汽車與交通工程學院,合肥 230009)
智能網(wǎng)聯(lián)汽車(CAV)是智能車和網(wǎng)聯(lián)車的結(jié)合,能為人們帶來更加安全、節(jié)能、環(huán)保和便捷的交通體驗,是現(xiàn)階段國際上廣泛認可的未來發(fā)展方向,智能網(wǎng)聯(lián)汽車的研究已成為不可避免的大趨勢。在智能網(wǎng)聯(lián)的環(huán)境下,車輛可與其他車輛通過車-車(V2V)通信交換位置、速度、加速度等信息,也可與路側(cè)單元通過車與交通設(shè)施(V2I)通信,獲取交通信號等信息。隨著研究的開展,智能網(wǎng)聯(lián)環(huán)境下的多車協(xié)同控制不但可以提高基礎(chǔ)的行駛安全,也為交通流暢性與燃油經(jīng)濟性的提高提供了新的解決思路。
目前,大量文獻研究智能網(wǎng)聯(lián)環(huán)境下車輛燃油經(jīng)濟性的優(yōu)化。Mierlo 等研究了駕駛行為對排放和油耗的影響,表明燃油消耗率也取決于車輛的駕駛行為。Xu 等針對不同坡度的巡航控制提出了采用反饋控制器和高速公路縱向速度規(guī)劃算法來提高車輛的安全性和燃油經(jīng)濟性。然而在城市交通環(huán)境下,路口處出于安全考慮設(shè)置的交通信號燈會導(dǎo)致交通流的頻繁中斷,車輛被迫加速或減速,增加了燃油消耗。為改善此現(xiàn)象,在信號交叉口處的生態(tài)駕駛被廣泛研究,利用即將到來的信號燈正時(SPaT)信息指導(dǎo)車輛以最優(yōu)速度接近,穿過和駛離交叉口,通過減少平均停車時間來減少交通擁堵,同時減少燃油消耗和CO排放等。Kamal 等通過當前道路和交通信息,提出了一種交通預(yù)測框架,使用模型預(yù)測控制(MPC)方法計算最優(yōu)控制輸入,提高了燃油經(jīng)濟性。Homchaudhuri 等提出了一種適用于城市擁堵交通環(huán)境下的燃油經(jīng)濟性的控制策略,并進一步采用一種快速模型預(yù)測控制(FMPC)策略,減少了計算時間。Wang 等描述了一種CAVs在信號走廊處的合作生態(tài)駕駛系統(tǒng),提出一種領(lǐng)航車和跟隨車之間的角色轉(zhuǎn)換協(xié)議以應(yīng)對不同CAV滲透率的狀況。
然而,大部分研究均是在理想環(huán)境中進行的,通信技術(shù)中固有的時延和丟包等不確定性可能導(dǎo)致CAV 的控制性能下降,甚至會危害到行車安全。Molnar 等研究了車隊在巡航控制中,通信時延和丟包對隊列穩(wěn)定性的影響,并設(shè)計了一種預(yù)測器補償數(shù)字控制器中的時延。Gao 等提出了一種針對含有通信時延和不確定動力學的異質(zhì)車隊的控制,保證了車輛的跟蹤性能。Liu等推導(dǎo)出了不同控制參數(shù)下保證車隊內(nèi)部穩(wěn)定性和隊列穩(wěn)定性的時延上界。上述研究中的時延多為確定不變的,沒有考慮到隨機時延或時變時延的情況。同時,研究內(nèi)容較為單一,主要在車隊巡航控制方面,少有研究時延對交叉口生態(tài)駕駛策略的影響。此外,目前研究大多僅限于仿真階段,與實際情況存在一定差距。
針對上述情況,本文中提出一種適用于多個信號交叉口的魯棒模型預(yù)測控制(RMPC)方法?;赟PaT 信息和前車狀態(tài)得到最優(yōu)目標車速,對車隊的燃油經(jīng)濟性和交通流暢性進行優(yōu)化;利用時變時延的上下界信息構(gòu)造Lyapunov 函數(shù),利用線性矩陣不等式(LMI)技術(shù)求解反饋控制律,保證時滯系統(tǒng)的魯棒穩(wěn)定;最后,進行仿真和智能小車試驗,驗證所提出方法的控制性能。
本文中考慮的是車隊在城市環(huán)境下通過一系列有交通信號燈交叉路口的場景。由于多車道場景包含換道切入等決策,超出本文研究范圍,故只選取簡化的單車道場景。同時,在智能網(wǎng)聯(lián)環(huán)境下,車輛可以通過V2V 和V2I通信獲得前方信號燈的信號定時信息和相鄰車輛的速度位置信息,原理圖如圖1所示。
圖1 車聯(lián)網(wǎng)原理圖
在隊列中,第輛車的縱向動力學模型為
式中:下標表示車輛;x表示狀態(tài)變量,包括車輛位置s和車速v;u表示單位質(zhì)量的驅(qū)動力或制動力;M、、分別為第輛車的整車裝備質(zhì)量、氣動阻力系數(shù)和擋風面積;、、、分別表示空氣密度、滾動阻力系數(shù)、重力加速度和道路坡度。
將動力學模型離散化,得到車輛的狀態(tài)空間方程:
式中Δ表示離散時間步長。
在城市道路環(huán)境下,因為交通堵塞而引起車輛頻繁的加減速會消耗大量的能耗。為了估算燃油的消耗量,引入一個燃油消耗估算模型:
在智能網(wǎng)聯(lián)汽車隊列協(xié)同控制研究中,常用的汽車巡航控制或者跟車模型,都無法避免車輛在交叉路口處因為紅燈而停車。在聯(lián)網(wǎng)的環(huán)境下,根據(jù)即將到來的交通信號燈的信號定時信息,可計算出目標車速的范圍。當車速位于這一范圍內(nèi)時,車輛可有效避免紅燈停車,減少停車次數(shù)和怠速時間,從而提高交通效率和燃油經(jīng)濟性?;谛盘柖〞r的目標車速范圍為
式中:、表示能在綠燈時間通過的最高和最低目標車速;表示城市道路條件下最大允許車速;s表示第輛車與第個交通信號燈之間的距離;表示交通信號燈的周期數(shù);、分別表示紅燈和綠燈持續(xù)時間;表示一個紅燈加綠燈的總持續(xù)時間即一個循環(huán)周期;表示汽車行駛時間;函數(shù)mod()表示求余數(shù)即求除以的余數(shù)。
通過計算式(5b)可以得到經(jīng)濟的巡航車速??紤]到燃油經(jīng)濟性,最優(yōu)目標車速變?yōu)?/p>
式中min|-[,]|表示在區(qū)間[,]內(nèi)與最接近的車速。當最優(yōu)巡航車速位于目標車速區(qū)間[,]內(nèi)時,目標車速選取經(jīng)濟巡航車速;其他情況下,目標車速選取車速區(qū)間[,]內(nèi)與巡航車速距離最近的車速。
同時考慮到車隊內(nèi)的跟車安全性,車輛的目標車速還與前車狀態(tài)有關(guān)。當車輛與前車1 的距離小于預(yù)定義的安全距離,且目標車速v大于前車目標車速v時,作為后車的車輛應(yīng)按式(7)以指數(shù)形式減速,從而加大跟車距離,避免發(fā)生碰撞:
綜合安全性和燃油經(jīng)濟性,定義新的狀態(tài)變量x′=[Δs,Δv],其中Δs為距離誤差,表示跟車距離與安全距離的差值,Δv為速度誤差,代表車速與目標車速之間的差值?v= v- v。
得到新的狀態(tài)空間方程:
為了便于描述,下文的x′、u′均簡化為、。
在通信和控制系統(tǒng)中,數(shù)據(jù)的感知、傳輸和處理均需要一定的時間,這些引起的時延均可被認為是輸入時延,本文將它們一起等效為時延。包含時變時延的離散非線性系統(tǒng)可表示為
下面給出RMPC 優(yōu)化問題的描述。為了解決時變時延所帶來的控制問題,設(shè)計的魯棒控制器需要滿足以下要求:(1)保持式(9)系統(tǒng)的魯棒穩(wěn)定;(2)對性能指標進行優(yōu)化。實際上,每次MPC 問題的控制目標是通過最小化性能指標計算得到,對于式(9)離散時滯系統(tǒng)的模型預(yù)測控制問題,可以描述為min-max優(yōu)化問題:
式(11b)表示系統(tǒng)的狀態(tài)預(yù)測模型,(++ 1|)表示時刻對1 時刻狀態(tài)的預(yù)測??紤]到交通流暢性、安全性和燃油經(jīng)濟性的綜合優(yōu)化,構(gòu)造二次性能指標如下:
式中、分別為狀態(tài)變量與控制量的加權(quán)矩陣。權(quán)值系數(shù)表達式如下:
式中:、、分別為距離誤差、速度誤差、加速度誤差的加權(quán)系數(shù);表示目標車速的范圍??梢愿鶕?jù)前后兩輛車之間的距離、速度差實時調(diào)整,保障車輛安全性。當目標車速范圍很小時,、可以取適當?shù)某?shù)。
為了使得閉環(huán)系統(tǒng)漸進穩(wěn)定,須設(shè)計狀態(tài)反饋控制律:
為轉(zhuǎn)化為便于Matlab 求解的優(yōu)化問題,將minmax 優(yōu)化問題轉(zhuǎn)化為帶有LMI 約束的優(yōu)化問題,引入一個二次函數(shù):
其中:
假設(shè)在時刻,有
令(∞|) = 0,所以有(∞|) = 0,將式(16)不等式兩邊從0到∞求和,可以得到
即可得到()的上界。
這就將原來式(11)的min-max 優(yōu)化問題轉(zhuǎn)化為最小化性能指標上界的優(yōu)化問題:
如果在時刻,存在6個正定矩陣、、、、、和標量>0、>0,滿足以下LMI優(yōu)化問題:
其中:= diag{,,,…,,I}
則增益矩陣=,魯棒模型預(yù)測控制律(+|) =(+|),能使魯棒性能指標上界最小化。
本文中設(shè)計的魯棒模型預(yù)測控制算法如下:
(1)輸入模型參數(shù)和定義初始狀態(tài),包括初始位置和速度;
(2)在時刻,利用Matlab 中的LMI 工具箱求解式(19)~式(21)優(yōu)化問題,得到增益矩陣;
(3)將時刻的控制律作用于式(9)被控系統(tǒng),得到下一時刻的狀態(tài);
(4)如果< k,重復(fù)(2)和(3),否則算法終止。
穩(wěn)定性證明如下。
在證明之前,首先給出引理1:設(shè)() 和()都是關(guān)于∈R的二次函數(shù),如果對于任意的∈R-{0},有() < 0,并且存在常數(shù)> 0使得() -() < 0,≠0 成立,則有() <0。
對李雅普諾夫函數(shù)(15)求差分,有
其中:=+
接下來令:
其中:=+
因為()是Lipschitz非線性函數(shù),滿足式(10),又可以寫成(+|) =()(),其中=diag{-I,0,…,0,I}。
根據(jù)引理1,存在數(shù)值> 0 使得() -() < 0成立,則有() < 0,即
令=,=,=,? =,根據(jù)Schur補引理,式(24)等價于
其中:= -+++(+) +?I
并將式(25)分別左乘和右乘矩陣diag{,,,…,,I,I},根 據(jù)=和Schur補引理,可得到式(20)成立。
因 為() < 0,且(+|)(+|) +(+|)(+|) > 0,可以得出Δ< 0,根據(jù)李雅普諾夫穩(wěn)定性理論,可得閉環(huán)系統(tǒng)漸進穩(wěn)定。
在這一節(jié)中,將驗證提出的模型與控制策略的可行性與有效性。考慮到時變時延,為每輛車都設(shè)計一個魯棒模型預(yù)測控制器,使車隊實現(xiàn)交通流暢性、燃油經(jīng)濟性的提高,同時保證車輛安全性。
本次試驗考慮單車道情況,每間隔500 m 設(shè)置一個交通信號燈,道路上有6 輛網(wǎng)聯(lián)車組成車隊。交通信號燈信息、每輛車的初始位置與速度均隨機選取。為模擬城市環(huán)境中的擁堵情況,交通信號選擇紅燈時間比綠燈時間長的情況,紅燈平均時間為40 s,綠燈平均時間為15 s,具體時間以(40,15)為間隔隨機選取。城市環(huán)境下的最大車速為20 m/s,最大加速度為1.5 m/s。車輛具體參數(shù)及其他仿真參數(shù)見表1。
表1 仿真基本參數(shù)
分別采用3 種控制方法進行仿真,一為本文提出的魯棒模型預(yù)測控制(RMPC)方法,同時設(shè)立聯(lián)網(wǎng)巡航控制(CCC)方法和快速模型預(yù)測控制(FMPC)方法兩種對比方法。 3 種方法均以式(7)作為目標車速,時延在0、0.2 和0.4 s 之間隨機選擇,概率分別為0.25、0.5和0.25。
采用本文提出的RMPC 方法車輛的基本性能如圖2 所示。圖2(a)的隊列軌跡圖顯示,車隊所有車輛均在綠燈時間內(nèi)通過路口,沒有因紅燈而停車。同時可以看到,車輛軌跡之間沒有交叉,即車輛之間未發(fā)生碰撞,安全性得到了保證。圖2(b)為車速曲線圖,可以看出6 輛車的車速曲線十分接近且平滑,表明本文所提出的控制方法可以保證車輛之間穩(wěn)定的協(xié)同控制。同時,整個過程中車輛并沒有進行頻繁的加減速,且車速始終大于0,這表明提出的方法能減少車輛的加減速次數(shù),且車輛在行駛過程中一直沒有因為交通信號燈而停車。
圖2 RMPC方法下的基本性能
圖3為分別采用兩種對比方法后的隊列軌跡圖??梢钥闯?,當采用CCC 方法時前5 輛車可以不停車地通過所有路口,但第6 輛車在過第一個路口時因為遇見紅燈而被迫停車。而當采用FMPC 方法時,隊列軌跡與采用RMPC 方法時十分接近,均可以不停車地通過所有路口,且車輛軌跡之間沒有交叉,保證了隊列的安全性。可以得出,本文提出的RMPC 方法相比于CCC 方法,避免了紅燈停車,提高了交通流暢性。
圖3 對比方法下的隊列軌跡
為了進一步比較時延情況下RMPC 方法和FMPC 方法的控制效果,對兩者的跟蹤誤差和燃油經(jīng)濟性進行了評價。同時,為了對比在不同時延狀態(tài)下的控制性能,設(shè)置3 組不同的時延分布:d00、d11和d22,分別以不同的概率在0、0.2和0.4 s的時延中隨機選擇,概率取值如表2 所示??梢钥闯?,從d00到d22,大時延出現(xiàn)的概率逐漸增加。
表2 時延概率設(shè)置
采用RMPC 方法和FMPC 方法在不同時延狀態(tài)下的跟蹤誤差如圖4 所示,包括速度誤差均值和距離誤差均值??梢钥闯觯S著大時延出現(xiàn)概率的增加,兩種控制方法下速度誤差和距離誤差的整體趨勢基本一致。在不同時延分布下,采用RMPC 方法時的兩種誤差均小于FMPC,控制性能較好。同時隨著大時延出現(xiàn)的比例增加,RMPC 方法的誤差并沒有發(fā)生明顯變化;而采用FMPC 方法時,當大時延出現(xiàn)的概率加大時,誤差也隨之增大,性能劣化明顯。
圖4 不同時延下的跟蹤誤差統(tǒng)計
圖5 為不同時延狀態(tài)下采用RMPC 方法和FMPC 方法的燃油經(jīng)濟性對比圖,英里每加侖(miles per gallon,mpg)越高代表燃油經(jīng)濟性越好。由圖可知,與FMPC 方法相比,采用RMPC 方法時,不論是單輛車還是車隊整體的燃油經(jīng)濟性均更好。同時,與跟蹤誤差類似,隨著大時延概率的增加,對比方法的mpg 逐漸減小,而RMPC 方法下仍能保持著較優(yōu)的燃油經(jīng)濟性。這意味著所提出的方法有著更優(yōu)更穩(wěn)定的燃油經(jīng)濟性能??梢哉J為,RMPC 方法的控制性能優(yōu)于FMPC 方法,同時隨著時延的變化,控制性能波動也遠小于對比方法。
圖5 不同時延下的燃油經(jīng)濟性統(tǒng)計
試驗使用智能小車算法驗證平臺,包括3 輛純電動智能小車、信號燈、信號燈控制器、路由器、總控制平臺、UWB 定位模塊、電壓電流測量模塊和環(huán)形跑道等。智能小車由感知模塊、小車計算模塊、小車主體和小車控制模塊組成。小車計算模塊為Intel主板,在接受信號燈狀態(tài)和前車狀態(tài)后,運行待驗證算法。小車控制模塊為STM32 單片機,接受來自小車計算模塊的控制信號,實時控制小車的速度和轉(zhuǎn)角,并實時采集小車的速度和轉(zhuǎn)角發(fā)送給小車計算模塊。試驗場景如圖6所示,試驗參數(shù)見表3。
表3 小車試驗參數(shù)
圖6 智能小車試驗場景
由于硬件特性和驅(qū)動能力,小車的控制步長設(shè)為0.5 s,時延則設(shè)為一個步長,信號燈距離為9.5 m,共10個路口。同樣的,采用3種控制方法進行試驗。隊列軌跡如圖7 所示。采用CCC 控制方法時,車3在過第3個路口時遇見紅燈而停車,而采用FMPC方法和RMPC 方法時均能全部在綠燈時間通過路口,提高了交通流暢性。另外,可以看出3 條軌跡之間沒有交集,且始終保持著一定的距離,而且與FMPC方法相比,采用RMPC 方法時車隊間距更加穩(wěn)定,意味著在沒有發(fā)生碰撞的同時,RMPC 方法可以更穩(wěn)定地維持以預(yù)設(shè)的安全距離行駛。
圖7 小車試驗隊列軌跡
表4 為RMPC 和FMPC 兩種控制方法下的跟蹤性能和耗電量對比。由表4可知,RMPC方法下每輛車的速度誤差和距離誤差均低于FMPC,同時耗電量也更小,證明本文提出方法的控制性能優(yōu)于FMPC,能源經(jīng)濟性更好,與仿真結(jié)果吻合。
表4 控制性能對比
本文中針對生態(tài)駕駛中的時變時延帶來的控制性能問題,提出了一種魯棒模型預(yù)測控制方法。建立了車隊的時滯離散模型,對安全性、燃油經(jīng)濟性和交通流暢性進行優(yōu)化。采用狀態(tài)反饋控制結(jié)構(gòu),利用LMI 技術(shù)和min-max 模型預(yù)測方法,計算狀態(tài)反饋增益矩陣,設(shè)計魯棒模型預(yù)測控制器。智能小車試驗結(jié)果與仿真結(jié)果吻合,表明本文提出的控制方法可以在不同時延狀態(tài)下,保證系統(tǒng)的魯棒穩(wěn)定,提高交通流暢性,且平均燃油經(jīng)濟性提高3.6%以上。在下一步的研究中,將進一步考慮乘坐人員的舒適性,包括縱向舒適性和垂向舒適性,并對綜合舒適性和燃油經(jīng)濟性兩個優(yōu)化目標進行解耦。