施國(guó)標(biāo) 周 倩 王 帥 鞠程赟

(北京理工大學(xué)機(jī)械與車輛學(xué)院， 北京 100081)

0 引言

無(wú)人駕駛已成為車輛領(lǐng)域的研究熱點(diǎn)，無(wú)人車輛轉(zhuǎn)向系統(tǒng)電動(dòng)化是實(shí)現(xiàn)無(wú)人駕駛的重要一環(huán)。雖然乘用車電動(dòng)化轉(zhuǎn)向系統(tǒng)，如電動(dòng)助力轉(zhuǎn)向(EPS)[1]、線控轉(zhuǎn)向系統(tǒng)(SBW)[2]，已得到了大量應(yīng)用，但前軸載荷較大的車輛仍然采用液壓助力轉(zhuǎn)向系統(tǒng)(HPS)。傳統(tǒng)HPS不具備主動(dòng)轉(zhuǎn)向功能，無(wú)法應(yīng)用于無(wú)人車輛[3]。近些年來(lái)，一種融合液壓助力轉(zhuǎn)向和電動(dòng)助力轉(zhuǎn)向(EPS)的電液復(fù)合轉(zhuǎn)向系統(tǒng)(Electro-hydraulic hybrid steering system, EHHS)為無(wú)人重型車轉(zhuǎn)向系統(tǒng)電動(dòng)化提供了理想解決方案[4]。與其他轉(zhuǎn)向系統(tǒng)相比，該EHHS轉(zhuǎn)向系統(tǒng)既有駕駛員操縱模式，又有無(wú)人駕駛模式，在駕駛員操縱模式下具有節(jié)能、隨速助力、主動(dòng)回正等優(yōu)點(diǎn)[5]。

目前對(duì)EHHS系統(tǒng)的研究主要集中在駕駛員操縱模式下的系統(tǒng)參數(shù)優(yōu)化[6]、高速行駛穩(wěn)定性[7]、理想轉(zhuǎn)向手感控制策略[8]等方面。而EHHS系統(tǒng)用于無(wú)人重型車的關(guān)鍵技術(shù)是轉(zhuǎn)向角度位置跟蹤控制策略，尚未見(jiàn)相關(guān)文獻(xiàn)報(bào)道。當(dāng)EHHS系統(tǒng)工作在無(wú)人駕駛模式時(shí)，轉(zhuǎn)向系統(tǒng)對(duì)給定理想轉(zhuǎn)角的跟蹤效果直接影響車輛路徑跟蹤效果及整車操縱穩(wěn)定性[9]，對(duì)駕駛安全有很大的影響，因此要求系統(tǒng)能快速、準(zhǔn)確地跟蹤期望轉(zhuǎn)角。而EHHS系統(tǒng)具有較強(qiáng)的非線性，且轉(zhuǎn)向執(zhí)行過(guò)程存在參數(shù)擾動(dòng)，并易受外界干擾影響，采用一般線性控制會(huì)存在較大的轉(zhuǎn)角跟蹤誤差，轉(zhuǎn)角跟蹤實(shí)時(shí)性及對(duì)外界擾動(dòng)的魯棒性較差[10]。

本文建立考慮系統(tǒng)參數(shù)不確定性和外界干擾的轉(zhuǎn)向系統(tǒng)完整非線性動(dòng)力學(xué)模型，設(shè)計(jì)一種自適應(yīng)雙閉環(huán)結(jié)構(gòu)的轉(zhuǎn)角跟蹤控制策略，在Matlab/Simulink環(huán)境下進(jìn)行階躍、正弦、斜坡控制信號(hào)的仿真試驗(yàn)，以驗(yàn)證控制策略。

1 轉(zhuǎn)向系統(tǒng)分析及建模

EHHS系統(tǒng)的工作原理如圖1所示。在無(wú)人駕駛模式時(shí)，駕駛員輸入方向盤扭矩Th為0，EPS模塊的控制器(ECU)接收轉(zhuǎn)向輪理想轉(zhuǎn)角信號(hào)，控制電機(jī)輸出轉(zhuǎn)向力矩Ta。力矩Ta作用在HPS模塊的轉(zhuǎn)閥扭桿上端使轉(zhuǎn)閥開(kāi)啟，油液流經(jīng)轉(zhuǎn)閥開(kāi)口輸入液壓缸產(chǎn)生液壓助力帶動(dòng)轉(zhuǎn)向橫拉桿輸出左右拉力，使轉(zhuǎn)向輪轉(zhuǎn)動(dòng)。

圖1 EHHS轉(zhuǎn)向系統(tǒng)工作原理圖Fig.1 Schematic of EHHS system

EPS模塊輸出的電機(jī)力矩Ta和HPS模塊輸出的液壓助力FL共同作用克服轉(zhuǎn)向阻力Tr和轉(zhuǎn)向系統(tǒng)內(nèi)部摩擦力Tf以實(shí)現(xiàn)前輪轉(zhuǎn)向，建立轉(zhuǎn)向動(dòng)力學(xué)模型為

(1)

式中δ——前輪轉(zhuǎn)角

rw——齒扇半徑

ip——轉(zhuǎn)向傳動(dòng)機(jī)構(gòu)力傳動(dòng)比

η——轉(zhuǎn)向傳動(dòng)機(jī)構(gòu)的效率

r——螺桿半徑

α——螺桿螺旋滾道的導(dǎo)程角

ρk——螺桿螺母副換算摩擦角

Iw——前輪及其固連模塊繞主銷的轉(zhuǎn)動(dòng)慣量

m——螺母及其固連部分的質(zhì)量

Cw——轉(zhuǎn)向系阻尼系數(shù)

Cr——活塞的阻尼系數(shù)

iw——轉(zhuǎn)向傳動(dòng)機(jī)構(gòu)角傳動(dòng)比

為后續(xù)便于建立模型及設(shè)計(jì)控制器，將式(1)進(jìn)行變換可得

(2)

其中

式中確定了轉(zhuǎn)向系統(tǒng)機(jī)械結(jié)構(gòu)Mn為定值，此外參數(shù)0

考慮系統(tǒng)參數(shù)不確定性、外部干擾，以及液壓助力系統(tǒng)、路面阻力及轉(zhuǎn)向系統(tǒng)內(nèi)部摩擦引入的非線性，可得二階非線性系統(tǒng)為

(3)

ΔPn、ΔYn——參數(shù)不確定值

Δun——未建模部分(包括側(cè)向風(fēng)及冰雪路面造成的外界干擾及其他系統(tǒng)內(nèi)部干擾等)

為進(jìn)一步明確電機(jī)轉(zhuǎn)向助力與轉(zhuǎn)向輪轉(zhuǎn)角的關(guān)系，需要對(duì)液壓助力、轉(zhuǎn)向阻力和系統(tǒng)內(nèi)部摩擦力做進(jìn)一步分析。式(3)中，HPS模塊輸出的液壓助力可描述為

(4)

式中A1、A2——各轉(zhuǎn)閥開(kāi)口面積

Qs——進(jìn)油口流量

y——活塞位移

Cd——節(jié)流孔流量系數(shù)

ρ——油液密度

Ap——液壓缸活塞有效面積

(5)

(6)

其中

ΔθL=Ta/KL

式中A3、A4——各轉(zhuǎn)閥開(kāi)口面積

W1、L1——閥口預(yù)開(kāi)間隙軸向長(zhǎng)度和周向長(zhǎng)度

W2、L2——短切口的軸向長(zhǎng)度和周向長(zhǎng)度

rf——閥芯半徑

ΔθL——轉(zhuǎn)閥扭桿轉(zhuǎn)動(dòng)角度

KL——轉(zhuǎn)閥扭桿剛度

轉(zhuǎn)閥扭桿輸出轉(zhuǎn)角與車輛前輪轉(zhuǎn)角存在線性關(guān)系

(7)

式中l(wèi)3——轉(zhuǎn)向節(jié)臂長(zhǎng)

l1——轉(zhuǎn)向搖臂長(zhǎng)

t——轉(zhuǎn)向器螺桿螺距

考慮到輪胎縱向力在左右輪胎載荷差別不大的情況下可忽略不計(jì)，假設(shè)輪胎側(cè)偏特性在線性范圍，本文輪胎轉(zhuǎn)向阻力矩主要包括側(cè)偏力產(chǎn)生的回正力矩和重力產(chǎn)生的回正力矩[11]，可得轉(zhuǎn)向阻力公式為

(8)

式中T1——由輪胎側(cè)向力產(chǎn)生的回正力矩

T2——重力產(chǎn)生的回正力矩

ltp——輪胎拖距

lhq——主銷后傾拖距

Kf——前輪輪胎的側(cè)偏剛度

β——質(zhì)心側(cè)偏角

a——質(zhì)心到前軸的距離

ωr——橫擺角速度v——車速

lnq——主銷內(nèi)移量

θ——主銷內(nèi)傾角G——前軸載荷

路面對(duì)車輛轉(zhuǎn)向的干擾通過(guò)車輛行駛過(guò)程中的轉(zhuǎn)向阻力矩Tr傳遞到轉(zhuǎn)向系統(tǒng)，故將該部分誤差歸于Δun。

轉(zhuǎn)向系統(tǒng)內(nèi)部非線性摩擦干擾對(duì)系統(tǒng)的影響主要表現(xiàn)為低速出現(xiàn)爬行、穩(wěn)態(tài)出現(xiàn)較大的靜差等[12]，當(dāng)前主要是通過(guò)建立LuGre模型、Stribeck模型[13]等研究系統(tǒng)摩擦特性，從而建立摩擦補(bǔ)償機(jī)制提高系統(tǒng)動(dòng)態(tài)性能。系統(tǒng)內(nèi)部摩擦力由Stribeck穩(wěn)態(tài)模型確定，即

Tf(ω)=[Tc+(Ts-Tc)e-(ω/ωs)2+Kv|ω|]sgn(ω)

(9)

式中Tc——庫(kù)倫摩擦力

Ts——最大靜摩擦力

Kv——黏性摩擦因數(shù)

ωs——Stribeck速率

ω——轉(zhuǎn)動(dòng)角速度

式(9)中的參數(shù)可通過(guò)試驗(yàn)方法測(cè)得。

2 轉(zhuǎn)角跟蹤控制器設(shè)計(jì)

基于前述EHHS系統(tǒng)模型分析，提出一種雙閉環(huán)控制結(jié)構(gòu)的自適應(yīng)轉(zhuǎn)向角跟蹤控制器對(duì)EHHS系統(tǒng)目標(biāo)轉(zhuǎn)角進(jìn)行跟蹤控制，控制框圖如圖2所示。自適應(yīng)控制器外控制環(huán)通過(guò)設(shè)計(jì)參數(shù)自適應(yīng)率以適應(yīng)模型參數(shù)攝動(dòng)，采用改進(jìn)滑?？刂朴善谕D(zhuǎn)向角計(jì)算期望轉(zhuǎn)向力矩。內(nèi)控制環(huán)則利用轉(zhuǎn)向電機(jī)PI電流控制器，實(shí)現(xiàn)對(duì)期望轉(zhuǎn)向力矩跟蹤，完成車輛轉(zhuǎn)向操作。

圖2 前輪轉(zhuǎn)角跟蹤控制策略框圖Fig.2 EHHS control algorithm for target steering angle tracking

2.1 參數(shù)自適應(yīng)外控制環(huán)

考慮EHHS系統(tǒng)的非線性及在轉(zhuǎn)向過(guò)程中存在的外界干擾，在外控制環(huán)中采用改進(jìn)滑?？刂朴?jì)算期望轉(zhuǎn)向力矩?；谵D(zhuǎn)角跟蹤誤差設(shè)計(jì)積分滑模面[14]

(10)

其中

式中e(t)——轉(zhuǎn)角跟蹤誤差

λ1≥0、λ2≥0，為了避免初始誤差較大時(shí)出現(xiàn)積分飽和現(xiàn)象，系統(tǒng)出現(xiàn)大幅度超調(diào)甚至不穩(wěn)定，λ2不能過(guò)大[15]。

在SMC控制系統(tǒng)中系統(tǒng)運(yùn)動(dòng)包括兩部分[16]：從任意初始狀態(tài)到達(dá)切換面，以及在控制律作用下保持滑模運(yùn)動(dòng)。帶有不確定性和外加干擾的系統(tǒng)一般采用的控制律為等效控制加切換控制，即

u=ueq+usw

(11)

(12)

式中L——有界且未知的集中不確定性

(13)

切換控制usw用于實(shí)現(xiàn)系統(tǒng)從初始點(diǎn)到切換面的趨近，具有對(duì)參數(shù)不確定和外加干擾的魯棒性，采用常值切換控制usw=ksgns(t)。為消減常值切換控制頻繁切換引起的抖振[17]，引入飽和函數(shù)重新定義切換控制usw=ksat(s(t))，其中飽和函數(shù)為

(14)

式中φ——邊界層厚度

隨著φ增大，系統(tǒng)抗抖振能力增強(qiáng)，但是會(huì)導(dǎo)致控制精度降低[18]。

在外控制環(huán)設(shè)計(jì)過(guò)程中，采用LEE等[19]提出的參數(shù)自適應(yīng)率，以彌補(bǔ)EHHS系統(tǒng)模型參數(shù)不確定性。自適應(yīng)率公式為

(15)

(16)

式中ρp、ρY——自適應(yīng)增益，為常數(shù)

綜上，可得最終控制律為

(17)

完成控制律設(shè)計(jì)后，利用Lyapunov原理證明系統(tǒng)漸進(jìn)穩(wěn)定性[20]，構(gòu)造Lyapunov函數(shù)為

(18)

其中 ΔPn=Pn-nΔYn=Yn-n

假設(shè)實(shí)際EHHS系統(tǒng)參數(shù)Pn、Yn為常數(shù)，則推導(dǎo)可得

(19)

2.2 電機(jī)電流內(nèi)控制環(huán)

對(duì)EPS模塊中的電機(jī)設(shè)計(jì)了基于穩(wěn)態(tài)的前饋控制器加PI反饋控制器用于控制電機(jī)電流，以跟蹤來(lái)自外控制環(huán)的期望轉(zhuǎn)向力矩。根據(jù)電機(jī)的電壓定律可獲得電樞回路微分方程為

(20)

(21)

對(duì)電流偏差采用PI控制，即反饋控制電壓為

(22)

其中

ΔI=Ii-Ir

內(nèi)環(huán)電機(jī)總控制律為

U=Uf+Ue

(23)

式中U——電機(jī)電壓L——電機(jī)電感

R——電機(jī)電阻I——電機(jī)電流

Kb——電機(jī)反電動(dòng)勢(shì)

θm——電機(jī)輸出軸轉(zhuǎn)角

im——蝸輪蝸桿傳動(dòng)比

Ii——理想電機(jī)電流

Ir——測(cè)得的實(shí)際電機(jī)電流

2.3 卡爾曼濾波器設(shè)計(jì)

通過(guò)轉(zhuǎn)角傳感器獲得控制器所需轉(zhuǎn)角反饋信號(hào)，為了避免傳感器高頻噪聲惡化控制效果[21]，采用卡爾曼濾波器進(jìn)行信號(hào)處理。考慮傳感器只能測(cè)得轉(zhuǎn)角信號(hào)，建立離散狀態(tài)方程和觀測(cè)方程為

(24)

其中

式中Ad——狀態(tài)轉(zhuǎn)移矩陣

Hd——測(cè)量轉(zhuǎn)移矩陣

ΔT——取樣時(shí)間

wk——過(guò)程噪聲(假設(shè)符合零均值高斯分布)

vk——觀測(cè)噪聲(假設(shè)符合零均值高斯分布)

先驗(yàn)狀態(tài)初始協(xié)方差為

P0=diag(σ1,σ2,σ3)

過(guò)程噪聲協(xié)方差為

Qk=diag(ζ1,ζ2,ζ3)

觀測(cè)噪聲協(xié)方差為

Rk=γ

對(duì)狀態(tài)和方差的時(shí)間進(jìn)行更新，即

(25)

進(jìn)一步實(shí)現(xiàn)狀態(tài)和方差的濾波更新

(26)

通過(guò)調(diào)節(jié)P0、Qk、Rk使得卡爾曼濾波器達(dá)到最優(yōu)濾波效果。

3 仿真

為了驗(yàn)證各種工況下EHHS轉(zhuǎn)向系統(tǒng)目標(biāo)轉(zhuǎn)角跟蹤控制算法的有效性，在Matlab/Simulink中搭建了控制器—轉(zhuǎn)向系統(tǒng)—車輛的閉環(huán)系統(tǒng)模型，并將控制結(jié)果與常規(guī)采用的PID控制的結(jié)果進(jìn)行對(duì)比，分析系統(tǒng)響應(yīng)速度、轉(zhuǎn)角跟蹤精度及抗干擾能力。

對(duì)幅值為0.6 rad的階躍前輪轉(zhuǎn)角信號(hào)進(jìn)行跟蹤，獲得前輪轉(zhuǎn)角跟蹤效果和跟蹤誤差如圖3a、3b所示，自適應(yīng)雙閉環(huán)控制器可以更快地跟蹤理想前輪轉(zhuǎn)角且穩(wěn)態(tài)誤差為零，EHHS系統(tǒng)在0.8 s內(nèi)能達(dá)到理想前輪轉(zhuǎn)角，響應(yīng)速度明顯優(yōu)于PID控制器。電機(jī)經(jīng)過(guò)減速器作用于轉(zhuǎn)向器上的電機(jī)力矩對(duì)比如圖3c所示，液壓助力對(duì)比如圖3d所示，建模時(shí)在轉(zhuǎn)向器上輸入高斯白噪聲模擬外界環(huán)境對(duì)系統(tǒng)轉(zhuǎn)向的力矩干擾，電機(jī)力矩及液壓助力對(duì)該部分干擾進(jìn)行了補(bǔ)償，避免了前輪轉(zhuǎn)角發(fā)生抖動(dòng)。

圖3 車速為60 km/h系統(tǒng)階躍響應(yīng)曲線Fig.3 Step response curves at speed of 60 km/h

圖4 車速為60 km/h系統(tǒng)正弦響應(yīng)曲線Fig.4 Weave test response curves at speed of 60 km/h

對(duì)幅值為0.6 rad、頻率為2 Hz的正弦前輪轉(zhuǎn)角信號(hào)進(jìn)行跟蹤，以模擬轉(zhuǎn)向輪快速左右擺動(dòng)的工況。調(diào)節(jié)PID控制器參數(shù)到最優(yōu)控制效果，轉(zhuǎn)角跟蹤對(duì)比如圖4a所示，相較于PID控制器，自適應(yīng)雙閉環(huán)控制器顯著減小轉(zhuǎn)角跟蹤延遲，提高轉(zhuǎn)角跟蹤精度。前輪轉(zhuǎn)角跟蹤誤差如圖4b所示，自適應(yīng)雙閉環(huán)控制器控制下誤差幅值低于0.001 rad，僅為PID控制的0.1%。兩種控制器控制下的電機(jī)輸出力矩和液壓助力如圖4c、4d所示，比較可知，自適應(yīng)雙閉環(huán)控制器輸出的轉(zhuǎn)向力矩更平緩，避免了轉(zhuǎn)向過(guò)程中出現(xiàn)抖動(dòng)。

圖5 車速60 km/h系統(tǒng)斜坡響應(yīng)曲線Fig.5 Stransition test response curves at speed of 60 km/h

對(duì)斜率為0.1 rad/s的斜坡轉(zhuǎn)角信號(hào)進(jìn)行跟蹤，以模擬轉(zhuǎn)向輪定轉(zhuǎn)速轉(zhuǎn)動(dòng)。前輪轉(zhuǎn)角跟蹤效果對(duì)比如圖5a所示，受機(jī)械限位結(jié)構(gòu)限制，在兩種控制器控制下8 s以后轉(zhuǎn)向輪轉(zhuǎn)角都不再變化。調(diào)節(jié)PID控制器參數(shù)使其獲得最優(yōu)控制效果，轉(zhuǎn)角跟蹤誤差如圖5b所示，自適應(yīng)雙閉環(huán)控制器控制下轉(zhuǎn)角誤差隨前輪轉(zhuǎn)角變大而變大，最大誤差低于0.000 1 rad，僅為PID控制的0.2%，且不存在大的誤差波動(dòng)，避免了前輪抖動(dòng)。兩控制器控制下EHHS系統(tǒng)輸出電機(jī)力矩及液壓助力如圖5c、5d所示，自適應(yīng)雙閉環(huán)控制器控制下電機(jī)力矩和液壓助力更平緩且波動(dòng)更小，在實(shí)際轉(zhuǎn)角控制過(guò)程中能獲得更好的控制效果。

當(dāng)EHHS系統(tǒng)參數(shù)發(fā)生變化時(shí)，自適應(yīng)雙閉環(huán)控制器及PID控制器的控制效果如圖6所示。由圖可知，系統(tǒng)參數(shù)發(fā)生變化會(huì)對(duì)PID控制系統(tǒng)瞬態(tài)響應(yīng)產(chǎn)生影響；由于控制器中加入了參數(shù)自適應(yīng)控制律，系統(tǒng)參數(shù)變化對(duì)自適應(yīng)雙閉環(huán)控制器控制瞬態(tài)響應(yīng)不會(huì)產(chǎn)生影響。

圖6 不同轉(zhuǎn)向系阻尼系數(shù)下系統(tǒng)的響應(yīng)曲線Fig.6 Response curves under different conditions with different damping coefficients

重型車輛空載和滿載差異較大，由圖7可知，車輛轉(zhuǎn)向阻力隨著載荷增大而增大，電機(jī)輸出助力隨之增大，載荷變化直接影響轉(zhuǎn)向系統(tǒng)電機(jī)力矩特性。由于電機(jī)能及時(shí)做出反饋，車輛載荷變化對(duì)自適應(yīng)雙閉環(huán)控制器的控制精度不會(huì)產(chǎn)生影響。

圖7 車輛載荷變化電機(jī)助力特性Fig.7 Motor assist characteristic curves with change of vehicle load

4 結(jié)束語(yǔ)

針對(duì)新型EHHS系統(tǒng)，考慮系統(tǒng)存在參數(shù)擾動(dòng)、非線性及外界干擾等特點(diǎn)，設(shè)計(jì)了一種應(yīng)用于重型車轉(zhuǎn)向系統(tǒng)無(wú)人駕駛模式的自適應(yīng)雙閉環(huán)結(jié)構(gòu)的目標(biāo)轉(zhuǎn)角跟蹤控制器，并將其與常規(guī)采用的PID控制器進(jìn)行比較。仿真結(jié)果表明，該控制器在階躍、正弦和斜坡等不同的輸入信號(hào)下都具有優(yōu)異的控制效果，提升了EHHS系統(tǒng)的瞬態(tài)響應(yīng)性能及穩(wěn)態(tài)性能，對(duì)干擾具有較好的補(bǔ)償效果，且顯著提高了跟蹤精度，降低了跟蹤誤差。