馬瑞蘭,郭唯浩,姚俊明,郭世永,*
(1.青島理工大學 機械與汽車工程學院,青島 266525;2.歌爾科技有限公司,青島 266100)
伴隨著汽車技術的進步及汽車保有量的增加,汽車已經(jīng)成為首選的出行工具。為滿足消費者對車輛舒適性日益增長的需求,車輛的輪廓變得更長、更高,體型的增加導致汽車的靈活性降低[1],從而增加了駕駛負擔。線控四輪轉(zhuǎn)向技術作為一種前沿的底盤電控技術,可以兼顧車輛的舒適性和靈活性[2],目前已經(jīng)被用于多款量產(chǎn)車型。其工作原理具體可以描述為當車輛低速行駛時,后輪轉(zhuǎn)角與前輪轉(zhuǎn)角相反,用以減小長軸距車輛在泊車工況下的轉(zhuǎn)彎半徑,達到降低駕駛員操縱負擔的目的;在車輛高速行駛時,后輪轉(zhuǎn)角與前輪轉(zhuǎn)角轉(zhuǎn)向相同,用于提高車輛的側(cè)向穩(wěn)定性,同時降低駕駛員的心理負擔。但是傳統(tǒng)的前輪轉(zhuǎn)向系統(tǒng)將轉(zhuǎn)向傳動比設定為固定值,這很難滿足不同車速下的需求,難以實現(xiàn)理想的橫向運動狀態(tài)響應特性。因此,線控四輪轉(zhuǎn)向應運而生,被用來提高自動駕駛車輛在循跡控制過程中的跟蹤精度和穩(wěn)定性[3-6]。
為了提高自動駕駛車輛在循跡控制過程中的跟蹤精度和穩(wěn)定性,首先搭建線控四輪轉(zhuǎn)向車輛模型[7],再結(jié)合Dugoff經(jīng)驗輪胎模型用來提高模型的精度、避免獲取復雜的輪胎參數(shù),然后分析橫向狀態(tài)參考模型得到飽和狀態(tài)下的車輛橫擺角速度??紤]到傳感器成本高昂,難以直接測量側(cè)向速度,另外車輛側(cè)偏力因路面附著系數(shù)的變化及輪胎飽和等因素呈現(xiàn)出非線性,再加上路面擾動及模型參數(shù)時變特性的影響也會降低橫向運動狀態(tài)的跟蹤性能,因此本文采用擴展卡爾曼濾波算法應對非線性的影響,融合改進積分法用以提高觀測器的魯棒性和觀測精度,提出一種自適應滑??刂撇呗?采用橫擺角速度誤差和質(zhì)心側(cè)偏角誤差定義滑模面,將前后軸側(cè)偏剛度作為自適應參數(shù),通過李雅普諾夫函數(shù)證明所提控制策略的穩(wěn)定性,最終,設計考慮駕駛員反應時間和上臂肌肉力的駕駛員模型,在Carsim/Simulink聯(lián)合仿真環(huán)境中搭建線控四輪轉(zhuǎn)向控制策略。
如圖1所示,線控四輪轉(zhuǎn)向車輛模型的輸入為前輪轉(zhuǎn)角和后輪轉(zhuǎn)角,模型狀態(tài)為質(zhì)心側(cè)偏角和橫擺角速度。車輛的側(cè)向速度差分方程和橫擺運動差分方程根據(jù)牛頓第二定律總結(jié)為[6]
圖1 線控四輪轉(zhuǎn)向車輛模型
(1)
輪胎形狀以及輪胎的縱向載荷決定輪胎在橫向運動過程中的性能,Dugoff輪胎模型將用于描述輪胎側(cè)向的動力學關系,其優(yōu)勢在于將輪胎模型綜合到側(cè)偏剛度中,提高模型保真度的同時避免復雜的參數(shù)調(diào)諧。圖2描述了車輛前后軸側(cè)偏力與側(cè)偏角的關系。
具體可以解釋為在非劇烈的駕駛運動中,輪胎為轉(zhuǎn)向運動提供的側(cè)向力較小,輪胎側(cè)向力與輪胎側(cè)偏角近似為線性關系;當輪胎進入飽和區(qū),隨著側(cè)偏角的增加,側(cè)向力不再上升。
前后軸的側(cè)偏角變化如式(2)所示:
式中:αf,αr分別為前后軸側(cè)偏角;δf,δr分別為前后軸輸入轉(zhuǎn)角;vx,vy分別為車輛質(zhì)心處的縱向和橫向車速。
Dugoff輪胎模型可以被描述為
Fy=-Cαf(λ)tanα
(3)
理想的橫向運動狀態(tài)響應特性隨車速變化,并且呈現(xiàn)不足轉(zhuǎn)向的趨勢,在固定車速下橫擺角速度增益不隨方向盤轉(zhuǎn)角以及路面發(fā)生變化。理想的參考橫擺角速度的穩(wěn)態(tài)響應由二自由度模型推導[8]:
(4)
當車輛的轉(zhuǎn)向運動過于劇烈,輪胎進入飽和,參考橫擺角速度將被修改為
(5)
式中:g為重力加速度。
質(zhì)心側(cè)偏角的理想值為0:
βref=0
(6)
現(xiàn)有的低成本車傳感器很難準確地觀測到質(zhì)心側(cè)偏角,質(zhì)心側(cè)偏角的觀測算法一直是車輛動力學研究過程中的熱點[9]。在觀測器的設計過程中,主要包括兩種策略,第1種是基于車輛動力學模型的觀測器,主要是擴展/無跡卡爾曼濾波、H∞/H2魯棒觀測器、T-S模糊觀測器及基于深度學習理論的觀測器等[10];第2種是基于車輛運動學算法的觀測器,此種觀測器大多使用積分法或改進的算法。依賴車輛動力學算法的觀測器很難獲取復雜的車輛參數(shù),并且車輛模型在輪胎飽和區(qū)呈現(xiàn)出高度的非線性,第2種觀測器的缺點是傳感器存在噪聲及偏置,產(chǎn)生的累計誤差難以控制[11]。本文采用擴展卡爾曼濾波算法用來克服車輛動力學的非線性問題,根據(jù)側(cè)向加速度ay的幅值融合改進積分法的優(yōu)點,避免大加速度下模型失真對觀測結(jié)果的影響,觀測器的構(gòu)成如圖3所示。
圖3描述了擴展卡爾曼濾波算法及其與改進積分法的融合過程,在改進積分法的計算過程中,為了降低傳感器信號中偏置和噪聲的影響,需要加入阻尼系數(shù)對積分項進行修正:
(7)
圖3 質(zhì)心側(cè)偏角融合觀測器
用于擴展卡爾曼濾波的車輛動力學模型經(jīng)過離散化為
(8)
擴展卡爾曼濾波存在2個過程,第1個過程為基于車輛動力學模型在時間上的更新:
1) 預測狀態(tài)更新
(9)
2) 預測協(xié)方差更新
(10)
第2個過程為基于傳感器測量的更新:
1) 擴展卡爾曼濾波增益更新
(11)
2) 狀態(tài)融合過程
(12)
3) 協(xié)方差更新
Pk|k=[I-LkHk]Pk|k-1
(13)
等效的前后軸側(cè)偏剛度因輪胎參數(shù)不同、轉(zhuǎn)向過程載荷轉(zhuǎn)移及輪胎飽和發(fā)生變化。在橫向控制器的設計過程中,系統(tǒng)等效為線性二自由度模型,前后軸的側(cè)偏剛度作為自適應參數(shù):
(14)
式(14)中,系統(tǒng)的系數(shù)矩陣分別為
車輛橫向控制中跟蹤誤差為
(15)
(16)
為了設計自適應律[13],定義側(cè)偏剛度偏差為
(17)
(18)
側(cè)偏剛度自適應律設計為
(19)
其中,系數(shù)矩陣的定義為
為驗證所提出線控四輪轉(zhuǎn)向算法的有效性,從神經(jīng)肌肉力學的角度建立擬人化駕駛員模型。理想的參考模型需要合理的轉(zhuǎn)角輸入,因此結(jié)合Carsim車輛動力學模型,在Simulink搭建駕駛員模型、參考模型、質(zhì)心側(cè)偏角觀測模型及控制器模型。
圖4 駕駛員模型
駕駛員通過注視行為獲得必要的信息過程被稱為預瞄。預瞄模型的建立通常包括3個要素:駕駛員在行駛過程中的預瞄時間、基于預瞄偏差的控制器及考慮駕駛員神經(jīng)肌肉反應的時間常數(shù)。圖4為本文所采用的駕駛員預瞄模型,其中d為駕駛員的預瞄距離,ey為在駕駛過程中的橫向偏差[14]。
駕駛員的預瞄時間在一定的取值范圍,根據(jù)需求在本文中被設定為經(jīng)驗常數(shù)T=d/vx。橫向跟蹤偏差被定義為[15-16]
ey=y(t+T)-y(t)-dtanψ
(20)
式中:ψ為航向角;y(t),y(t+T)分別為當前時刻、預瞄時刻的橫向坐標。
根據(jù)比例-積分-微分的反饋策略,駕駛員模型輸出的轉(zhuǎn)角為
(21)
圖5 Carsim/Simulink聯(lián)合仿真
式中:Kp,Ki,Kd分別為反饋策略中的比例增益、積分增益及微分增益;t為誤差積分的時間。
按照圖5所示,進行Carsim/Simulink聯(lián)合仿真。圖中,輸入量設置為vx,ay,γ:車輛的縱向車速、車輛的橫向加速度、車輛的橫擺角。
在仿真中采用延時傳遞函數(shù)和一階慣性傳遞函數(shù)模擬駕駛員上臂的神經(jīng)肌肉的反應特性:
(22)
在Carsim軟件中設定車輛動力學模型,車輛類型選擇C-Class車輛,具體參數(shù)信息如表1所示。設計定速100 km/h的雙移線仿真工況[17],在仿真過程對比地設計了無控制的前輪轉(zhuǎn)向車輛。
表1 車輛參數(shù)
圖6表明,線控四輪轉(zhuǎn)向的質(zhì)心側(cè)偏角的峰值遠小于無控制的前輪轉(zhuǎn)向車輛,驗證線控四輪轉(zhuǎn)向系統(tǒng)可以提高橫向運動的穩(wěn)定性??刂菩Ч鐖D7所示。
圖7(b)及圖7(c)清晰地展示了線控四輪轉(zhuǎn)向車輛的橫擺角速度實際值與參考值的誤差較小,質(zhì)心側(cè)偏角趨近于理想的參考值0,驗證了自適應滑??刂破骺梢蕴岣邫M向運動狀態(tài)的跟蹤性能。同時,質(zhì)心側(cè)偏角實際值和觀測值基本一致,表明本文所提出擴展卡爾曼濾波與改進積分法融合算法具有良好的觀測性能。
圖7 控制效果對比
由圖7(a)可以看出,在線控四輪轉(zhuǎn)向系統(tǒng)中前軸轉(zhuǎn)角和后軸轉(zhuǎn)角的方向相同,從而提高換道過程中車身的穩(wěn)定性。
本文所提出的擴展卡爾曼濾波與改進積分法融合的策略可以良好地觀測出車輛的實時質(zhì)心側(cè)偏角值,Dugoff輪胎模型更準確描述了輪胎側(cè)向力和側(cè)偏角的關系,擴展卡爾曼濾波解決了對非線性模型最優(yōu)估計的問題,在增大側(cè)向加速度時切換為改進的積分法,避免了輪胎飽和導致模型失真的問題。
本文所提的自適應滑??刂破髂軌蜃赃m應前后軸剛度的變化,實現(xiàn)對橫擺角速度和質(zhì)心側(cè)偏角的閉環(huán)控制并具有良好的控制效果,達到減小車輛橫向運動中的軌跡跟蹤偏差和降低質(zhì)心側(cè)偏角的峰值的目的。