任 玥,冀 杰,趙 穎,梁藝瀟,鄭 玲
(1. 西南大學工程技術學院,重慶 400715;2. 重慶大學汽車工程學院,重慶 400044)
隨著傳感器技術、芯片算力和人工智能技術的快速發(fā)展,以智能化、電動化、網(wǎng)聯(lián)化、共享化為代表的“新四化”成為了汽車工業(yè)前沿技術的發(fā)展趨勢。由于能夠極大地減輕駕駛員負荷,改善交通效率,減少道路交通事故[1],在“新四化”中,智能化技術尤其受到重視和資本的青睞,近5 年來得到了顯著的發(fā)展。而作為自動駕駛的“四肢”,智能汽車路徑跟蹤控制是整個自動駕駛功能實現(xiàn)的基石,也是車輛智能化進程中從駕駛輔助階段邁向高度自動駕駛階段的關鍵問題。
近年來,全球范圍內(nèi)的學者針對車輛路徑跟蹤控制進行了廣泛的研究。以模型不同來區(qū)分,車輛路徑跟蹤控制可分為基于幾何學模型、運動學模型和動力學模型[2]。幾何學模型較為簡單,僅考慮車輛與參考路徑相對位姿和阿克曼轉(zhuǎn)向關系。最經(jīng)典的幾何學路徑跟蹤控制算法包括pure pursuit算法和Stanley算法。2005年斯坦福大學無人駕駛賽車采用Stanley算法取得了DARPA挑戰(zhàn)賽的冠軍[3]。
相比于幾何學模型,運動學模型考慮了車輛縱橫運動耦合關系。Rajamani 等[4]研究了前輪轉(zhuǎn)向車輛倒車場景下的路徑跟蹤問題,在非線性運動學模型基礎上,基于輸入狀態(tài)反饋線性化控制器,引入了基于預瞄的輸入輸出反饋線性化控制器,提高了控制精度。Raffo等[5]基于離散線性化后的時變運動學模型,提出了廣義模型預測控制路徑跟蹤控制方法,在低速工況效果較好?;谶\動學模型的路徑跟蹤控制方法簡單實用。在中低速和小曲率工況下能夠取得較好的控制效果,但在高速大曲率工況下,由于車輛動力學耦合加劇,側(cè)滑發(fā)生,加之輪胎非線性特性凸顯,控制效果較差。
為更精確地描述車輛在不同工況下的動力學特性,提高路徑跟蹤精度,車輛動力學模型被廣泛應用??紤]不同的控制性能需求,基于車輛平面動力學模型,多種控制方法被運用到車輛路徑跟蹤控制器設計中,包括模型預測控制(MPC)[6-7]、復合非線性反饋控制(CNF)[8]、基于線性不等式的魯棒控制(LMI)[9]和滑模控制(SMC)[10-11]等等,均獲得了較好的跟蹤效果。
無論采用何種模型,準確的狀態(tài)參數(shù)獲取都是取得較好控制精度的前提。上述研究大多假設車輛全狀態(tài)參數(shù)均可直接獲取,而實際中某些系統(tǒng)關鍵參數(shù)(如車輛側(cè)向速度、質(zhì)心側(cè)偏角等)往往難以直接精確測量。而對于該類參數(shù),大多數(shù)學者采用EKF 和UKF[12-13]等模型觀測方法進行估計。但是上述觀測方法估計效果也與模型精度直接相關,而為保證計算效率,一般采用簡化車輛模型進行觀測,其在一定程度上會影響參數(shù)估計效果。
為減小模型導致的估計誤差,提高路徑跟蹤效果,本文中基于分布式驅(qū)動智能電動汽車,設計了基于最小模型誤差觀測的一體化路徑跟蹤控制器,其控制構(gòu)架如圖1所示。
圖1 智能汽車路徑跟蹤控制框架
整體控制架構(gòu)主要包括3 部分。首先基于最小模型誤差準則,設計了車輛縱、側(cè)向速度和橫擺角速度觀測器。在此基礎上,根據(jù)期望路徑的期望橫擺響應,考慮轉(zhuǎn)向系統(tǒng)的潛在失效風險導致的不確定性,設計了基于徑向基神經(jīng)網(wǎng)絡逼近的自適應滑模轉(zhuǎn)向控制器。最后,基于分布式驅(qū)動電動汽車驅(qū)動/制動轉(zhuǎn)矩獨立可控的優(yōu)勢,設計了穩(wěn)定性集成控制器和轉(zhuǎn)矩分配策略,進一步提高了車輛路徑跟蹤過程的穩(wěn)定性和機動性。
對于路徑跟蹤問題,忽略車輛垂向運動對縱橫運動的耦合作用,采用包含縱向運動、側(cè)向運動和橫擺運動的3 自由度單軌車輛動力學模型,如圖2所示。
圖2 3自由度單軌車輛動力學模型
在前輪轉(zhuǎn)角比較小的情況下,基于小角度假設,車輛動力學模型可表示為
式中:m和Iz為整車質(zhì)量和轉(zhuǎn)動慣量;vx、vy和γ分別為車輛縱向速度、橫向速度和橫擺角速度;lf和lr為質(zhì)心至前、后軸距離;B為車輛輪距;Fxf和Fxr為前、后軸縱向力;Fyf和Fyr為前、后軸側(cè)向力。
得益于分布式驅(qū)動電動汽車線控底盤,在車輛運行時,其轉(zhuǎn)向盤轉(zhuǎn)角和四輪的驅(qū)動/制動力矩都能夠通過電機精確測得。車輛的縱、橫向加速度和橫擺角速度能夠通過IMU 獲取。而車輛的縱、橫向速度難以直接精確測量,故建立一個5輸入、3輸出和3狀態(tài)的觀測系統(tǒng),分別表示為
式中:Tfl、Tfr、Trl、Trr和δ分別為四輪驅(qū)動/制動轉(zhuǎn)矩和前輪轉(zhuǎn)角;aˉx、aˉy和γˉ分別為縱向加速度、橫向加速度和橫擺力矩的觀測值。
在車輛動態(tài)運動過程中,由于車輛動力學模型受縱、橫運動耦合影響,輪胎的縱、側(cè)向力存在著嚴重的非線性特性,且難以用公式準確描述,故在此將輪胎縱、側(cè)向力表示為
式中:ΔF和ω分別為輪胎力的不確定項和觀測噪聲;Fˉ為輪胎縱、側(cè)向力的標稱值,可用式(4)線性模型表示。
式中:r為車輪半徑;Ci和αi分別為前、后軸名義側(cè)偏剛度和側(cè)偏角。考慮輪胎力的不確定性,聯(lián)立式(1)~式(4),狀態(tài)觀測系統(tǒng)狀態(tài)方程可表示為
其中f(x(t),u(t))=[f1,f2,f3]T,并有
其中ax、ay和?通過式(1)和式(3)計算得出。
式(5)中Es(t)代表狀態(tài)誤差,其由輪胎力不確定性和過程噪聲兩部分組成,表示為
其中:
過程噪聲ω(t)可用滿足協(xié)方差矩陣為Q的高斯分白噪聲表示。
同理,系統(tǒng)輸出方程可表示為
采用前向歐拉差分法,連續(xù)系統(tǒng)可離散為
式中ΔT為采樣時間。在每一步的狀態(tài)轉(zhuǎn)移過程中,認為輪胎力不確定項不變,故在k-1時刻到k時刻的輪胎力不確定項均為d(k)。
由式(3)可知,輪胎力模型為不確定模型,其導致在式(9)離散狀態(tài)觀測方程中存在不確定項d(k),會對觀測精度造成影響,通過設計模型誤差補償器能夠提高模型精度,再通過擴展卡爾曼濾波算法消除隨機過程誤差和測量誤差,能夠取得較好的估計精度。
為最小化輪胎力不確定性對系統(tǒng)觀測的影響,定義最小模型誤差補償器目標函數(shù)[14]為
對于二次型目標函數(shù)J[d(k)],根據(jù)最小值原理,其極值在處取得,故使得誤差補償目標函數(shù)最小的模型不確定值d(k)可通過下式計算[15]:
其中:
需要注意的是,式(14)中的協(xié)方差權重矩陣Γ需要滿足:
式中Z為逼近R的時間指數(shù)。在實際調(diào)試過程中,由于隨機高斯白噪聲的存在,最優(yōu)的協(xié)方差矩陣Γ隨著系統(tǒng)狀態(tài)而時變,難以精確求得。但由于在系統(tǒng)轉(zhuǎn)移過程中,輪胎力不確定性的作用遠遠大于過程噪聲,故一般取較大的Γ值能夠獲取較好的狀態(tài)觀測精度和魯棒性。
通過式(14)的迭代計算,能夠估計輪胎模型不確定度,并代入狀態(tài)更新方程,從而降低因模型誤差引起的估計偏差,為進一步地提高模型估計精度,采用擴展卡爾曼濾波算法消除過程誤差ω和觀測誤差ν。具體迭代過程可表示為
式中A(k)和C(k)分別表示系統(tǒng)雅克比矩陣,具體可描述為
具體EKF迭代更新流程如圖3所示。
其中誤差協(xié)方差矩陣的初值P(0)通過系統(tǒng)初始輸入和初始狀態(tài)計算[15]。通過迭代更新計算,可實時估計出車輛橫擺角速度、縱向車速和側(cè)向車速,并計算求得車輛質(zhì)心側(cè)偏角。
圖3 擴展卡爾曼濾波算法迭代流程
路徑跟蹤預瞄模型如圖4 所示,其運動學模型可表示為
式中:eyp、Δψ分別為側(cè)向位移偏差和航向角偏差;ρ(s)為參考路徑曲率;Xp為預瞄距離,在低速時應適當小一些保證跟蹤精度,高速時適當大一些,防止控制抖振引起的車輛失穩(wěn),其應隨車速自適應變化。
式中:kd為預瞄車速增益;ldc為靜態(tài)預瞄距離。
圖4 預瞄跟蹤模型
通過預先的路徑規(guī)劃可獲得路徑點坐標、曲率序列,結(jié)合車輛自身GPS 坐標信息獲取預瞄點位置信息,即可計算距離預瞄點最近的坐標點位置信息。取預瞄點與參考點的側(cè)向誤差和航向角誤差為狀態(tài)變量xe=[eyp,Δψ],輸入為期望橫擺角速度ue=γd,輸出為ye=xe。將式(18)寫作線性狀態(tài)空間方程形式:
式中:AL和BL為線性化狀態(tài)轉(zhuǎn)移矩陣,其計算方法同式(17);CL= diag(1,1)為輸出矩陣。
最優(yōu)期望橫擺角速度可基于模型預測控制算法(MPC),通過求解預測時域最小目標函數(shù)取得,如式(21)所示。
式中:ymin和ymax為系統(tǒng)輸出約束最大和最小值;umin和umax為系統(tǒng)輸入約束最大和最小值。
由此,路徑跟蹤問題被轉(zhuǎn)化為了橫擺角速度跟蹤問題,定義滑模面為橫擺角速度跟蹤誤差s=γ-γd,則有
其中:
式中:δ為最終車輛實際前輪轉(zhuǎn)角;δw為車輛線控轉(zhuǎn)向電機控制器實際輸入轉(zhuǎn)角;Kw為轉(zhuǎn)向系統(tǒng)齒輪比。由于轉(zhuǎn)向系統(tǒng)存在幅值約束,且由于線控轉(zhuǎn)向系統(tǒng)可能會存在一定的性能衰退、失效等非線性特性,故轉(zhuǎn)向電機輸入轉(zhuǎn)角和車輛實際前輪轉(zhuǎn)角不呈線性關系,其不確定性用Δδ表示。Δδ未知,且存在時變可能。由于徑向基神經(jīng)網(wǎng)絡具有復雜函數(shù)逼近功能,且具有在線自適應調(diào)節(jié)能力,故在此采用徑向基神經(jīng)網(wǎng)絡對系統(tǒng)不確定性Δδ進行逼近,并設計自適應滑??刂破?,如圖5所示。
神經(jīng)網(wǎng)絡輸入為滑??刂破鲗嶋H輸出的轉(zhuǎn)向電機轉(zhuǎn)角指令δw,輸出為系統(tǒng)不確定性Δδ。輸入輸出關系為
圖5 基于RBFNN補償?shù)淖赃m應滑模控制器
式中:j表示第j個網(wǎng)絡隱含層,本文中取j=5;W為網(wǎng)絡理想權值;ε為網(wǎng)絡逼近誤差;?和Δδ?分別代表神經(jīng)網(wǎng)絡估計權值和估計輸出。
基于式(22),設計控制率為
式中η≥bKwεmax。將式(25)代入式(22)可得
定義Lyapunov函數(shù)為
式中τ為正數(shù)。則有
取神經(jīng)網(wǎng)絡估計權值自適應率為
則?= -η|s|+sbKwε≤0。
為驗證本文提出的狀態(tài)觀測算法與路徑跟蹤控制器的有效性,本節(jié)通過Carsim/Matlab 聯(lián)合仿真平臺進行仿真測試,測試車輛主要參數(shù)如表1所示。
表1 車輛主要參數(shù)
此部分主要對第1 節(jié)中基于最小模型誤差的狀態(tài)觀測器性能進行驗證,仿真結(jié)果如圖6所示。
選取速度80 km/h 的單移線工況,路徑曲率由圖6(a)所示。從圖6(b)和圖6(c)中側(cè)向速度和橫擺角速度的估計結(jié)果可以看出,由于前文觀測方程中輪胎力輸入采用的是線性近似模型,與實際輪胎動力學特性存在誤差,故在進行狀態(tài)更新迭代時會產(chǎn)生相應誤差,但最小模型誤差補償器通過在模型迭代過程中自適應補償,能夠有效地減小模型誤差的影響,故最終估計結(jié)果較為可靠,側(cè)向速度和橫擺角速度最大估計誤差分別為8.3%和5.1%,為控制器的設計提供了保障。
為驗證本文所提出的自適應滑模路徑跟蹤控制器性能,選取路面附著系數(shù)為0.7、車速為100 km/h時的雙移線工況,以模擬車輛高速換道避撞情況。仿真過程中假設車輛轉(zhuǎn)向電機因通信數(shù)據(jù)丟包等情況[17]造成30%失效。為更好地突出本文所提出的控制策略的有效性,采用常規(guī)滑??刂婆c本文算法進行比較,仿真結(jié)果如圖7所示。
圖6 狀態(tài)觀測仿真結(jié)果
從圖7(a)可以看出,由于轉(zhuǎn)向系統(tǒng)存在部分失效,實際輸出轉(zhuǎn)角小于控制器輸出需求,故常規(guī)滑??刂破髟谲囕v換到鄰道和切回主道時由于系統(tǒng)輸入響應不足,發(fā)生了相對較大的偏移,而自適應滑模控制器通過RBF 網(wǎng)絡辨識系統(tǒng)的失效情況,并給予控制器一定的補償量,所以自適應滑??刂撇呗栽诟欉^程中路徑更平滑,距參考路徑的偏移量也較小。從圖7(b)和圖7(c)中可以看出,常規(guī)滑模控制在該工況下的最大側(cè)向位移偏移與航向角偏移分別達到了0.31 m 和0.038 rad,而自適應滑??刂破鞯淖畲髠?cè)向位移偏移與航向角偏移僅為0.18 m 與0.36 rad。圖7(d)中也能反映出常規(guī)SMC 由于系統(tǒng)失效導致實際轉(zhuǎn)向盤輸入轉(zhuǎn)角較小,而自適應SMC能夠通過神經(jīng)網(wǎng)絡補償器保證足夠的控制響應。綜上所述,本文提出的控制策略具有更高的路徑跟蹤精度,尤其是在控制系統(tǒng)出現(xiàn)不確定性或性能衰退時,具有更好的魯棒性。
圖7 雙移線仿真測試結(jié)果
本文中針對分布式驅(qū)動電動智能汽車的自主循跡問題,設計了基于觀測器的路徑跟蹤控制構(gòu)架,首先考慮到車輛關鍵狀態(tài)參數(shù)縱、側(cè)向車速難以直接精確測量,設計了基于最小模型誤差準則的狀態(tài)觀測器,減小了由于非線性輪胎模型誤差對估計精度的影響,取得了較可靠的參數(shù)估計結(jié)果。然后針對轉(zhuǎn)向控制,提出了基于期望橫擺響應的自適應滑??刂撇呗?,并采用徑向基神經(jīng)網(wǎng)絡對轉(zhuǎn)向系統(tǒng)的不確定性進行逼近,基于李雅普諾夫函數(shù)證明了控制系統(tǒng)的魯棒性。最后,采用直接橫擺力矩控制器和最優(yōu)轉(zhuǎn)矩分配策略,進一步提高了車輛在路徑跟蹤過程中的穩(wěn)定性。
通過CarSim/Matlab 聯(lián)合仿真測試對本文所提出的控制策略進行了仿真驗證,結(jié)果表明:基于最小模型誤差準則的狀態(tài)觀測器,在估計模型存在誤差的情況下,能夠有效地提高估計精度。自適應路徑跟蹤控制器能夠基于估計結(jié)果,在模型存在一定不確定性的情況下保證較好的跟蹤精度和魯棒性。
本文中僅考慮了勻速狀態(tài)的路徑跟蹤工況,下一步工作將結(jié)合車輛局部路徑規(guī)劃決策,將縱向控制器結(jié)合到路徑跟蹤控制器中,實現(xiàn)車輛在不同車速、不同附著情況下穩(wěn)定、精準的路徑跟蹤。