基于優(yōu)化動力學模型的路徑跟蹤控制研究

何智成 王煜凡 韋寶侶 李智 卜騰辰

摘要：

針對一般路徑跟蹤模型預測控制器在高速大曲率工況下適應性差的問題，提出了一種基于優(yōu)化動力學模型的自適應預測時域控制策略。首先，為解決經(jīng)典動力學模型在較高側(cè)向加速度工況下精度不足的問題，建立了包含側(cè)傾轉(zhuǎn)向和變形轉(zhuǎn)向特性的優(yōu)化模型，實現(xiàn)了車輛狀態(tài)的較高精度預測；其次，為解決高速大曲率工況下固定預測時域控制效果不佳的問題，提出了基于二維高斯函數(shù)的自適應預測時域策略，以低算法復雜度實現(xiàn)了預瞄距離的實時調(diào)整；最后，通過CarSim/Simulink聯(lián)合仿真實驗驗證了控制器在雙移線道路上的控制效果，結(jié)果表明，橫向位置峰值誤差降低45.1%，橫擺角峰值誤差降低72.4%，設計的控制器對極限工況有更好的適應性。

關(guān)鍵詞：智能網(wǎng)聯(lián)汽車；橫向動力學優(yōu)化；路徑跟蹤；模型預測控制；自適應預測時域

中圖分類號：U467

DOI：10.3969/j.issn.1004132X.2024.06.006

開放科學（資源服務）標識碼（OSID）：

Research on Path Tracking Control Based on Optimized Dynamics Model

HE Zhicheng1? WANG Yufan1? WEI Baolv1，2? LI Zhi1? BU Tengchen1

1.State Key Laboratory of Advanced Design and Manufacturing Technology for Vehicle，

Hunan University，Changsha，410082

2.SAIC GM Wuling Automobile Co.，Ltd.，Liuzhou，Guangxi，545007

Abstract： In response to the poor adaptability of conventional path tracking model predictive controllers under high-speed and large-curvature conditions， an adaptive prediction horizon control strategy was proposed based on optimized dynamic models. Firstly， to address the issues of insufficient accuracy of classical dynamics models under high lateral acceleration conditions， an optimized model including roll steer and compliance steer was established， achieving higher precision prediction of vehicle states. Secondly， to address the issues of fixed prediction horizon control under high-speed and large-curvature conditions， an adaptive prediction horizon strategy was proposed based on two-dimensional Gaussian function， achieving real-time adjustment of preview distances with low algorithm complexity. Finally， the effectiveness of the controller on double-lane-change roads was verified throught CarSim/Simulink joint simulation. Results show that a reduction of 45.1% in lateral position peak errors and 72.4% in yaw angle peak errors indicate better adaptability of the designed controller to extreme conditions.

Key words： intelligent connected vehicle； lateral dynamics optimization； path tracking； model predictive control； adaptive prediction horizon

收稿日期：20231002

基金項目：湖南省杰出青年基金（2021JJ10016）；廣西科技重大專項（2021AA04004）；柳州市科技計劃（2022AAA0101）

0? 引言

隨著移動互聯(lián)網(wǎng)、大數(shù)據(jù)和云計算等新一代信息技術(shù)的革命性突破，智能交通系統(tǒng)蓬勃發(fā)展［1］，其中自動駕駛技術(shù)是其關(guān)鍵推動力之一［2］。車輛在高速大曲率工況下產(chǎn)生較大的側(cè)向加速度容易發(fā)生側(cè)滑失穩(wěn)現(xiàn)象，威脅駕乘人員的安全［3］，因此，智能汽車在此類工況下實現(xiàn)穩(wěn)定準確的路徑跟蹤是自動駕駛運動控制的重要挑戰(zhàn)。

國內(nèi)外學者在路徑跟蹤控制研究中采用了多種控制算法，包括PID控制［4-5］、滑模控制［6-7］、魯棒控制［8］、模型預測控制（model predictive control， MPC）［9］和模糊控制［10］等。近年來，由于MPC算法能夠系統(tǒng)地處理車輛動力學約束，逐漸成為了研究熱點。然而，在高速大曲率工況下，固定預測時域可能會影響路徑跟蹤的精度和車輛穩(wěn)定性［11］，為此，一些學者提出了一系列改進措施。LIU等［12］提出了一種變步長的模型離散化方法，該方法在滿足計算實時性的同時擁有更長的預測時域。白國星等［13］基于非線性模型預測控制算法，將預測時域同車輛速度和穩(wěn)態(tài)轉(zhuǎn)向角結(jié)合起來以設計控制器。CHEN等［14］提出了一種基于路徑的自適應預測時域路徑跟蹤轉(zhuǎn)向控制器。預測時域的變化策略應綜合考慮車輛狀態(tài)和道路信息，而且要以較低的算法復雜度滿足實時性要求。

基于優(yōu)化動力學模型的路徑跟蹤控制研究——何智成? 王煜凡? 韋寶侶等

中國機械工程 第35卷 第6期 2024年6月

另外，針對側(cè)向加速度較大時經(jīng)典動力學模型［15］精度不足的問題，劉文營等［16］根據(jù)縱向車速、等效側(cè)偏剛度的變化規(guī)律，對線性二自由度模型進行了擴展。陳炎［17］在二自由度模型的基礎(chǔ)上加入了側(cè)傾運動修正，可以在仿真和參數(shù)辨識時簡化運算。關(guān)龍新等［18］基于MPC算法提出了一種前饋雙補償抗擾動機制，然后通過擴張狀態(tài)觀測器實時估計車輛未知擾動量用于前饋補償。然而，路徑跟蹤控制高度依賴于車輛動力學模型，因此如何建立更高精度的動力學模型，并運用于控制器設計仍需要開展進一步研究。

本文針對智能車輛路徑跟蹤控制器在高速大曲率工況下適應能力不足的問題展開研究。首先，引入懸架和轉(zhuǎn)向系統(tǒng)的動態(tài)特性來修正橫向動力學方程，建立車輛優(yōu)化動力學模型；其次，推導了優(yōu)化的預測模型，并設計了關(guān)于車輛速度與道路曲率的自適應預測時域策略，實現(xiàn)了預瞄距離實時調(diào)整的MPC控制；最后，通過CarSim/Simulink聯(lián)合仿真驗證設計控制器的有效性。

1? 優(yōu)化車輛動力學模型

1.1? 經(jīng)典動力學建模與靜態(tài)穩(wěn)定性因數(shù)分析

車輛動力學模型是設計路徑跟蹤控制器的基礎(chǔ)，經(jīng)典三自由度車輛動力學模型如圖1所示，表達式如下：

mv·x=mvyφ·+Fxf+Fxr－Fyfδf

mv·y=－mvxφ·+Fyf+Fyr

Izφ¨=lfFyf－lrFyr（1）

式中，m為整車質(zhì)量；Iz為繞z軸的轉(zhuǎn)動慣量；lf、lr為質(zhì)心到前后軸距離；vy、vx為橫向、縱向速度；φ為橫擺角；δf為前輪轉(zhuǎn)角；Fxf、Fxr為前后輪的縱向力；Fyf、Fyr為前后輪側(cè)向力。

前后車輪側(cè)偏角分別為

αf=arctan（vy+lfφ·vx）－δf≈vy+lfφ·vx－δf（2）

αr=arctan（vy－lrφ·vx）≈vy－lrφ·vx （3）

穩(wěn)態(tài)橫擺角速度增益和靜態(tài)穩(wěn)定性因數(shù)分別為

φ·δf=vxL1+mL2（lfCαr－lrCαf）v2x? （4）

Ks=mL2（lfCαr－lrCαf） （5）

式中，L為軸距；Cαf、Cαr為前后輪側(cè)偏剛度。

由式（2）～式（5）推導側(cè)偏角與靜態(tài)穩(wěn)定性因數(shù)的關(guān)系為

δf=αf－αr+L/R=（1+Ksv2）L/R（6）

式中，v為車輛速度；R為行駛半徑。

由式（6）可知，靜態(tài)穩(wěn)定性因數(shù)僅由車輛基礎(chǔ)參數(shù)組成，忽略了懸架與轉(zhuǎn)向系統(tǒng)的影響，而車輛在高速大曲率工況下會產(chǎn)生較大的載荷轉(zhuǎn)移，懸架和轉(zhuǎn)向系統(tǒng)結(jié)構(gòu)會發(fā)生較大變形，靜態(tài)穩(wěn)定性因數(shù)精度會下降，經(jīng)典動力學模型不能較好地體現(xiàn)車輛操控特性。

1.2? 橫向動力學優(yōu)化及模型建立

在側(cè)向加速度較大時，車輛懸架和轉(zhuǎn)向系統(tǒng)變形會導致四輪定位參數(shù)變化，對車輛橫向動力學產(chǎn)生較大的影響。目前的研究主要是通過算法的魯棒性解決建模過程中產(chǎn)生的誤差，但復雜的算法對控制系統(tǒng)的實時性要求提出挑戰(zhàn)。本文將側(cè)傾轉(zhuǎn)向、側(cè)傾外傾、變形轉(zhuǎn)向和變形外傾產(chǎn)生的四輪定位參數(shù)變化補償?shù)絼恿W方程中，將試驗數(shù)據(jù)和動力學機理融合進行建模，優(yōu)化車輛的橫向動力學。

在懸架K（kinematic）特性研究中，車輛側(cè)傾會引起前轉(zhuǎn)向輪繞主銷的轉(zhuǎn)動和后輪繞垂直于地面軸線的轉(zhuǎn)動，即車輪束角會產(chǎn)生一個側(cè)傾轉(zhuǎn)向角的變化，如圖2a所示。同時，車輛側(cè)傾會引起車輪繞x軸的轉(zhuǎn)動，即車輪外傾角會產(chǎn)生一個側(cè)傾外傾角的變化，如圖2b所示。在懸架C（compliance）特性研究中，懸架導向桿系元件在側(cè)向力或回正力矩作用下發(fā)生變形，引起前輪繞主銷的轉(zhuǎn)動和后輪繞垂直于地面軸線的轉(zhuǎn)動，即車輪束角會產(chǎn)生一個變形轉(zhuǎn)向角的變化，如圖2c、圖2d所示。同時，變形也會引起車輪繞x軸的轉(zhuǎn)動，即車輪外傾角會產(chǎn)生變形外傾角的變化，如圖2e、圖2f所示。

四輪定位參數(shù)變化系數(shù)如表1所示。一般假

設側(cè)向力作用在輪胎的幾何中心，但車輛實際在轉(zhuǎn)彎中會產(chǎn)生輪胎拖矩TPF、TPR，影響質(zhì)心到前后軸的距離。載荷轉(zhuǎn)移（LLT）、車輛的驅(qū)動力或制動力和車身變形都會影響到穩(wěn)定性因數(shù)。側(cè)傾轉(zhuǎn)向和變形轉(zhuǎn)向產(chǎn)生的車輪束角變化可以等效為車輪轉(zhuǎn)向角的幾何修正，優(yōu)化后的前后輪側(cè)偏角分別為

αfo=vy+lfoφ·vx－（δf+kf1r+kf3Fyfo－kf5Mzfo）（7）

αro=vy－lroφ·vx－（kr1r+kr3Fyro－kr5Mzro）（8）

式中，F(xiàn)yfo、Fyro為優(yōu)化后的前后輪側(cè)向力；Mzfo、Mzro為優(yōu)化后的前后輪回正力矩；lfo、lro為優(yōu)化后的質(zhì)心到前后軸距離；r為車輛側(cè)傾角。

車輛側(cè)傾角與側(cè)向加速度存在滯后的線性關(guān)系，于是可將車輛側(cè)傾角轉(zhuǎn)化為

φr=kay=k（v·y+vxφ·） （9）

式中，k為轉(zhuǎn)換系數(shù)；ay為側(cè)向加速度。

外傾角會讓車輪具有繞旋轉(zhuǎn)軸線與地面交點方向滾動的趨勢，由于受車軸的約束兩車輪一起前行，而輪胎在接地點會產(chǎn)生外傾力，于是車輛側(cè)傾外傾和變形外傾產(chǎn)生的車輪外傾角變化可以等效為側(cè)向力的力修正，前后輪的外傾力分別為

Fyfγ=Cγf（kf2r+kf4Fyfo－kf6Mzfo） （10）

Fyrγ=Cγr（kr2r+kr4Fyro－kr6Mzro） （11）

式中，Cγf、Cγr分別為前后輪外傾剛度；Fyfγ、Fyrγ分別為前后輪外傾側(cè)向力。

聯(lián)立式（7）～式（11），可得到優(yōu)化后的前后輪側(cè)向力Fyfo和Fyro，實現(xiàn)橫向動力學的優(yōu)化。

綜上所述，融入車輛側(cè)傾與懸架變形特性的優(yōu)化動力學模型為

v·x=vyφ·+（Fxf+Fxr－Fyfoδfo）/m

v·y=－vxφ·+（Fyfo+Fyro）/m

φ¨=［（lf－TPF）Fyfo－（lr+TPR）Fyro］/Iz

X·=vxcos φ－vysin φ

Y·=vxsin φ+vycos φ（12）

式中，X·、Y·分別為車輛X、Y方向的速度。

1.3? 優(yōu)化動力學模型實車驗證

本文目標車輛為某款暢銷的純電動微型汽車，車輛基礎(chǔ)參數(shù)如表2所示。車輛滿載工況下的懸架KC特性試驗現(xiàn)場如圖3所示。

表1中的優(yōu)化系數(shù)通過加權(quán)最小二乘（WLS）法［19］估算，以側(cè)傾轉(zhuǎn)向系數(shù)為例，假設車輛側(cè)傾角與車輪束角的關(guān)系函數(shù)為Ytoe=Xrollθ，則

Tj=1r11r21riτjkj（13）

i=1，2，…，n? j=fl，fr，rl，rr

式中，Ytoe為車輪束角；θ為待定系數(shù)；Xroll為車輛側(cè)傾角；Tj為各車輪側(cè)傾轉(zhuǎn)向束角；τj為各車輪初始束角；kj為各車輪優(yōu)化系數(shù)。

定義損失函數(shù)并求解系數(shù)矩陣如下：

J（θ）=12（XrollGθ－Ytoe）T（XrollGθ－Ytoe） （14）

θ=（XTrollGTRXroll）－1XTrollGTGYtoe （15）

式中，G為對角權(quán)重矩陣。

懸架KC試驗數(shù)據(jù)與估計的優(yōu)化系數(shù)如圖4所示。車輛左轉(zhuǎn)時，會壓縮右前輪減小束角，伸長左前輪增加束角，從而增加不足轉(zhuǎn)向；車輛右轉(zhuǎn)時，會壓縮右后輪增加束角，伸長左后輪減小束角，從而增加不足轉(zhuǎn)向。轉(zhuǎn)化為兩輪模型的前軸側(cè)傾轉(zhuǎn)向系數(shù)kf1為0.1067，

后軸側(cè)傾轉(zhuǎn)向系數(shù)kr1為0.1617。同理可得其余優(yōu)化系數(shù)。

基于式（6）～式（8）修正側(cè)傾轉(zhuǎn)向角，推導出由側(cè)傾轉(zhuǎn)向影響產(chǎn)生的擴展穩(wěn)定性因數(shù)為

K1=－kf1r－kr1rLay （16）

基于式（6）～式（11），將車輪束角和外傾角變化依次轉(zhuǎn)換為車輪轉(zhuǎn)角修正，整理出動態(tài)穩(wěn)定性因數(shù)Kd表達式為

δf+∑6i=1Δδfi－Δδri=LR（1+Ksv2） （17）

δf=LR［1+（Ks+∑6i=1Ki）v2］=LR（1+Kdv2） （18）

式中，Δδfi、Δδri分別為前后輪修正轉(zhuǎn)向角；Ki為擴展穩(wěn)定性因數(shù)。

該款微型電動車性能有限，進行側(cè)向加速度為0.4g的定半徑穩(wěn)態(tài)回轉(zhuǎn)試驗如圖5所示，根據(jù)試驗數(shù)據(jù)計算得到擴展穩(wěn)定性因數(shù)如圖6所示。各擴展穩(wěn)定性因數(shù)在動態(tài)穩(wěn)定性因數(shù)中占比較大，側(cè)傾與變形轉(zhuǎn)向特性對車輛操縱穩(wěn)定性影響顯著，驗證了建立優(yōu)化動力學模型的必要性。

在操控穩(wěn)定性試驗中，車輛進行75 km/h的蛇形繞樁試驗，采集的橫擺角速度和側(cè)向加速度數(shù)據(jù)與模型仿真數(shù)據(jù)比較如圖7、圖8所示，模型誤差如圖9、圖10所示。車輛進行100 km/h的0.4g角階躍輸入瞬態(tài)試驗，試驗數(shù)據(jù)與模型仿真數(shù)據(jù)比較如圖11、圖12所示。數(shù)據(jù)表明，在蛇形繞樁試驗中，與經(jīng)典模型相比，優(yōu)化模型的側(cè)向加速度均方根誤差下降40.2%，橫擺角速度均方根誤差下降48.8%，并且峰值誤差大幅降低，誤差統(tǒng)計如表3所示。在0.4g角階躍輸入試驗中，優(yōu)化模型的穩(wěn)態(tài)側(cè)向加速度誤差下降59.4%，穩(wěn)態(tài)橫擺角速度誤差下降66.7%，CarSim模型與實車試驗數(shù)據(jù)吻合，可作為后續(xù)設計控制器的控制對象，優(yōu)化動力學模型精度顯著提高。

2? 模型預測控制器（MPC）設計

2.1? 基于優(yōu)化動力學模型的MPC設計

基于前文的優(yōu)化動力學模型設計路徑跟蹤控制器能夠提高MPC精度，進一步設計自適應預測時域策略可提高控制器的魯棒性，控制原理如圖13所示。本文針對高速大曲率工況下路徑跟蹤問題，假設車輛縱向保持高速，僅控制前輪轉(zhuǎn)角。選取式（12）的狀態(tài)向量ξ=（vy，vx，φ，φ·，Y，X）T，控制量u=（δf），輸出量η=（φ，Y，X）T。將模型線性化，將ξ·=f（ξ，u）在工作點（ξr，ur）一階泰勒展開并忽略高階項，得

ξ·=f（ξr，ur）+fξ（ξ－ξr）+fu（u－ur）（19）

聯(lián)立式（12）與式（19），通過一階差商法得到離散系統(tǒng)模型：

ξ（k+1）=Akξ（k）+Bku（k）+dk（20）

η（k）=Ckξ（k）（21）

式中，Ak為狀態(tài)矩陣；Bk為輸入矩陣；dk為模型誤差補償;Ck為輸出矩陣。

將式（20）、式（21）中對前輪轉(zhuǎn)角的控制轉(zhuǎn)變

為對轉(zhuǎn)角增量的控制，擴展狀態(tài)量得到新的狀態(tài)空間為

ξ～（k+1|t）=A～kξ～（k|t）+B～kΔu（k|t）+d～k

η（k|t）=C～kξ～（k|t）

ξ～（k|t）=（ξ（k|t），u（k－1|t））T（22）

MPC通過預測模型計算系統(tǒng)預測時域Np內(nèi)的輸出，通過求解滿足目標函數(shù)及各種約束的優(yōu)化問題，得到控制時域Nc內(nèi)的控制序列。基于優(yōu)化動力學模型推導的優(yōu)化預測矩陣為

H（t）=Ψξ（t）+ΘΔU（t）+ΓΦ（t）（23）

H（t）=η（k+1）η（k+2）η（k+Nc）η（k+Np）ΔU（t）=Δu（k）Δu（k+1）Δu（k+Nc－1）

式中，H（t）為預測輸出序列；ΔU（t）為控制輸入序列；Ф（t）為測量誤差序列；Ψ、Θ和Γ為狀態(tài)空間遞推矩陣。

設計目標函數(shù)和約束條件如下：

J=min∑Npi=1‖η（k+i|t）－ηref（k+i|t）‖2Q+

∑Nc－1i=0‖Δu（k+i|t）‖2R+ρε2（24）

－δf，lim≤δf≤δf，lim

－Δδlim≤Δδ≤Δδlim

－βlim≤β≤βlim

－ay，min－ε≤ay≤ay，max+ε

－αlim≤αf，r≤αlim（25）

式中，Q、R為權(quán)重矩陣；ρ為松弛因子權(quán)重系數(shù)；ε為松弛因子。

目標函數(shù)優(yōu)化求解問題可以轉(zhuǎn)化為標準二次型規(guī)劃問題，求解得到控制增量序列和松弛因子。選擇控制增量序列第一個元素反饋給系統(tǒng)并重復上述過程，實現(xiàn)滾動優(yōu)化控制。

2.2? 自適應預測時域策略

MPC算法中的預測時域參數(shù)對智能車輛路徑跟蹤效果影響顯著。不同車速下對控制器預測時域的選擇有不同的要求［11］。在低速工況下，對車輛操控穩(wěn)定性要求不高，偏小的預測時域有更好的控制效果，增大預測時域可能會降低跟蹤精度。反之，在高速工況下，對車輛操控穩(wěn)定性要求較高，增大預測時域能獲取更遠的道路信息以保證車輛的穩(wěn)定性，減小預測時域可能會導致轉(zhuǎn)向抖動。同時，預測時域的選擇還需考慮前方道路的曲率信息，特別是在高速大曲率極限工況下，應根據(jù)預瞄距離內(nèi)的道路曲率實時調(diào)整預測時域，以避免過多的車道偏離。綜上所述，極限工況下預測時域需要依據(jù)車速及道路曲率實時調(diào)整。

本文通過測試智能汽車在雙移線路徑上的跟蹤能力驗證控制器的優(yōu)化效果。參考路徑如圖14所示［20］，期望橫擺角如圖15所示，表達式為

Yref=dy1（1+tanh（z1））－dy2（1+tanh（z2））

z1=shdx1（X－x1）－sh2

z2=shdx2（X－x2）－sh2（26）

φref=arctan（dy1shdx1cosh2（z1）－dy2shdx2cosh2（z2）） （27）

式中，Yref為期望橫向位置；φref為期望橫擺角；dx1、dx2、dy1、dy2和sh為雙移線調(diào)整參數(shù)。

基于曲率公式定義預瞄距離內(nèi)的道路彎曲度（mean road curvature， MRC）：

ρMRC=1Np∑Npi=1|Y¨ref（Xi）|（1+Y·ref（Xi）2）32（28）

式中，Y·ref（Xi）、Y¨ref（Xi）分別為預瞄點的一階、二階導數(shù)。

高速工況下需要考慮控制器的實時性，自適應預測時域策略應避免復雜計算。基于二維高斯函數(shù)的集中性和均勻變動性，設計預測時域關(guān)于車速與道路彎曲度的函數(shù)：

Np=round（Aexp（（v－vmax）2σ21+ρ2MRCσ22）） （29）

式中，A為預測時域上限；vmax為車速上限；σ1為車速影響因子；σ2為道路彎曲度影響因子。

根據(jù)車輛特性標定參數(shù)得到預測時域離線數(shù)據(jù)庫，其三維分布如圖16所示。

3? 試驗仿真分析

3.1? 仿真環(huán)境

基于CarSim/Simulink搭建聯(lián)合仿真平臺，驗證本文提出的優(yōu)化控制策略。對比分析基于經(jīng)典動力學模型的MPC控制（traditional dynamic model-MPC， TR-MPC）、基于優(yōu)化動力學模型的MPC控制（optimizing dynamics model-MPC， OM-MPC）和基于優(yōu)化動力學模型的自適應預測時域MPC控制（optimizing dynamics model-adaptive prediction horizon-MPC，OM-AP-MPC）在雙移線道路上的跟蹤精度和車輛穩(wěn)定性。該微型電動車最高時速為100 km/h，本文高速工況選取72 km/h，中低速工況選取54 km/h。假定路面高附著系數(shù)為0.85，低附著系數(shù)為0.45。MPC控制器初始參數(shù)如表4所示。

3.2? 結(jié)果分析

車速v=72 km/h且附著系數(shù)μ=0.85的高速工況下，跟蹤誤差曲線如圖17、圖18所示。車速為v=54 km/h且附著系數(shù)μ=0.45的低附工況下，跟蹤誤差曲線如圖19、圖20所示。高速或低附著工況下，車輛過彎時呈現(xiàn)明顯的側(cè)傾和變形轉(zhuǎn)向特性，OM-MPC控制器輸出更加精確的控制量，有效降低了路徑跟蹤橫向誤差和橫擺角誤差。

高速大曲率工況下，圖18中OM-MPC控制器在50～100 m的出彎處車輛橫擺角波動依舊較大。引入OM-AP-MPC控制器，各控制器期望路徑和期望橫擺角跟蹤曲線如圖21、圖22所示。圖23、圖24中，OM-MPC和OM-AP-MPC控制器能有效減小橫向誤差、橫擺角誤差的峰值。自適應預測時域策略提高了路徑跟蹤精度和車輛穩(wěn)定性，使車輛在75～100 m處快速收斂至直道。

本文設計的三種控制器誤差統(tǒng)計如表5所示。相比于TR-MPC控制，本文提出的OM-AP-MPC控制器路徑跟蹤誤差的平均值降低37.8%，橫擺角誤差的平均值降低60.3%，控制效果得到了顯著提升。

圖25為橫擺角速度質(zhì)心側(cè)偏角相位圖，由圖可見，OM-AP-MPC控制器相圖所占面積最小，表明車輛的質(zhì)心側(cè)偏角在相同橫擺角速度下被控制在更小的范圍內(nèi)，操控穩(wěn)定性得到了提升。圖26為道路彎曲度及預測時域變化曲線，隨著道路彎曲度的變化，預測時域能夠?qū)崟r計算調(diào)整，提高了跟蹤精度并加快了誤差收斂速度。

4? 結(jié)論

（1）針對一般路徑跟蹤控制器在高速大曲率工況下適應性不足的問題，本文提出了一種基于優(yōu)化動力學模型的自適應預測時域模型預測控制策略。

（2）通過蛇形繞樁和0.4g角階躍實車操穩(wěn)性實驗驗證，優(yōu)化動力學模型能更精確地體現(xiàn)車輛狀態(tài)。通過雙移線道路仿真實驗驗證，基于優(yōu)化動力學模型的模型預測控制效果顯著優(yōu)于一般模型預測控制器，進一步引入自適應預測時域策略，可提高車輛的跟蹤精度和穩(wěn)定性。

（3）本文在仿真環(huán)境下初步驗證了基于優(yōu)化動力學模型的自適應預測時域MPC控制（OM-AP-MPC）的效果，為解決高速大曲率等極限工況下的路徑跟蹤問題提供了新的思路。

參考文獻：

［1］? 邊明遠， 李克強. 以智能網(wǎng)聯(lián)汽車為載體的汽車強國戰(zhàn)略頂層設計［J］. 中國工程科學， 2018， 20（1）：52-58.

BIAN Mingyuan， LI Keqiang. Strategic Analysis on Establishing an Automobile Power in China Based on Intelligent & Connected Vehicles［J］. Strategic Study of Chinese Academy of Engineering， 2018， 20（1）：52-58.

［2］? 熊璐， 楊興， 卓桂榮， 等. 無人駕駛車輛的運動控制發(fā)展現(xiàn)狀綜述［J］. 機械工程學報， 2020， 56（10）：127-143.

XIONG Lu， YANG Xing， ZHUO Guirong， et al. Review on Motion Control of Autonomous Vehicles［J］. Journal of Mechanical Engineering， 2020， 56（10）：127-143.

［3］? 金輝， 李世杰. 基于極限車速的車輛穩(wěn)定性控制研究［J］. 汽車工程， 2018， 40（1）：48-56.

JIN Hui， LI Shijie. A Research on Vehicle Stability Control Based on Limited Speed［J］. Automotive Engineering， 2018， 40（1）：48-56.

［4］? 王京起， 陳慧巖， 鄭培. 應用模糊自適應PID和預瞄策略的自主車輛轉(zhuǎn)向控制［J］. 汽車工程， 2003， 35（4）：367-371.

WANG Jingqi， CHEN Huiyan， ZHENG Pei. Application of Fuzzy Adaptive PID and Previewing Algorithm in Steering Control of Autonomous Land Vehicle［J］. Automotive Engineering， 2003， 35（4）：367-371.

［5］? ZHAO Pan， CHEN Jiajia， SONG Yan， et al. Design of a Control System for an Autonomous Vehicle Based on Adaptive-PID［J］. International Journal of Advanced Robotic Systems， 2012， 9（2）：51314.

［6］? 郭景華， 李琳輝， 胡平， 等. 基于模糊邏輯的無人駕駛車縱向多滑模控制［J］. 中國公路學報， 2013， 26（1）：170-176.

GUO Jinghua， LI Linhui， HU Ping， et al. Longitudinal Multiple Sliding-mode Control of Unmanned Vehicle via Fuzzy Logic［J］. China Journal of Highway and Transport， 2013， 26（1）：170-176.

［7］? 叢森森， 高峰， 許述財. 基于動態(tài)穩(wěn)定域的車輛橫縱向穩(wěn)定性協(xié)同控制［J］. 汽車工程， 2022， 44（6）：900-908.

CONG Sensen， GAO Feng， XU Shucai. Cooperative Control of Vehicle Lateral and Longitudinal Stability Based on Dynamic Stability Region［J］. Automotive Engineering， 2022， 44（6）：900-908.

［8］? WANG Rongrong， JING Hui， HU Chuan， et al. Robust H∞ Path Following Control for Autonomous Ground Vehicles with Delay and Data Dropout［J］. IEEE Transactions on Intelligent Transportation Systems， 2016， 17（7）：2042-2050.

［9］? 龔建偉， 姜巖， 徐威. 無人駕駛車輛模型預測控制［M］. 北京：北京理工大學出版社，2014：57-59.

GONG Jianwei， JIANG Yan， XU Wei. Model Predictive Control of Self-driving Vehicles［M］. Beijing：Beijing Institute of Technology Press， 2014：57-59.

［10］? ONIEVA E， NARANJO J E， MILANS V， et al. Automatic Lateral Control for Unmanned Vehicles via Genetic Algorithms［J］. Applied Soft Computing， 2011， 11（1）：1303-1309.

［11］? 張世義， 顧小川， 唐爽， 等. 采用變時域模型預測的車輛路徑跟蹤控制方法［J］. 華僑大學學報（自然科學版）， 2021， 42（2）：141-149.

ZHANG Shiyi， GU Xiaochuan， TANG Shuang， et al. Vehicle Path Tracking Control Method Using Varying Horizon of Model Predictive Control［J］. Journal of Huaqiao University（Natural Science）， 2021， 42（2）：141-149.

［12］? LIU Kai， GONG Jianwei， CHEN Shuping， et al. Model Predictive Stabilization Control of High-speed Autonomous Ground Vehicles Considering the Effect of Road Topography［J］. Applied Sciences， 2018， 8（5）：822.

［13］? 白國星， 孟宇， 劉立， 等. 基于可變預測時域及速度的車輛路徑跟蹤控制［J］. 中國機械工程， 2020， 31（11）：1277-1284.

BAI Guoxing， MENG Yu， LIU Li， et al. Path Tracking Control of Vehicles Based on Variable Prediction Horizon and Velocity［J］. China Mechanical Engineering， 2020， 31（11）：1277-1284.

［14］? CHEN B C， TSAI C T， LEE K. Path-following Steering Controller of Automated Lane Change System with Adaptive Preview Time［C］∥2015 IEEE International Conference on Systems， Man， and Cybernetics. Hong Kong， 2015：2522-2526.

［15］? 余志生. 汽車理論［M］. 北京：機械工業(yè)出版社，2008：144-146.

YU Zhisheng. Automobile Theory［M］. Beijing：China Machine Press， 2018：144-146.

［16］? 劉文營， 劉偉， 崔曉川. 二自由度車輛動力學模型的擴展研究［J］. 中國測試， 2016， 42（增刊2）：76-79.

LIU Wenying， LIU Wei， CUI Xiaochuan. Research on Extension of Two Degree of Freedom Vehicle Dynamics Model［J］. China Measurement & Test， 2016， 42（S2）：76-79.

［17］? 陳炎. 汽車轉(zhuǎn)向動力學的改進的二自由度數(shù)學模型及其參數(shù)辨識［J］. 車輛與動力技術(shù)， 1990， 12（2）：45-52.

CHEN Yan. Improved Two-degree-of-freedom Mathematical Model and Parameter Identification of Vehicle Steering Dynamics［J］. Vehicle & Power Technology， 1990， 12（2）：45-52.

［18］? 關(guān)龍新， 顧祖飛， 張超， 等. 考慮系統(tǒng)復雜擾動的智能車模型預測路徑跟蹤控制［J］. 汽車工程， 2022， 44（12）：1844-1855.

GUAN Longxin， GU Zufei， ZHANG Chao， et al. Model Predictive Path Following Control of Intelligent Vehicles Considering System Complex Disturbances［J］. Automotive Engineering， 2022， 44（12）：1844-1855.

［19］? 麥爾斯. 經(jīng)典和現(xiàn)代回歸分析及其應用［M］. 北京： 高等教育出版社，2015.

MYERS R H. Classical and Modern Regression with Applications［M］. Beijing：Higher Education Press， 2015.

［20］? FALCONE P， ERIC TSENG H， BORRELLI F， et al. MPC-based Yaw and Lateral Stabilisation via Active Front Steering and Braking［J］. Vehicle System Dynamics， 2009， 46（1）：611-628.

（編輯? 王艷麗）

作者簡介：

何智成，男，1983年生，教授、博士研究生導師。研究方向為智能汽車與智能控制、先進結(jié)構(gòu)與智能設計。E-mail：hezhicheng815@163.com。

韋寶侶（通信作者），男，1978年生，博士研究生。研究方向為智能底盤與轉(zhuǎn)向系統(tǒng)。E-mail：Baolv.wei@sgmw.com.cn。