基于最優(yōu)滑移率的車輛軌跡跟蹤控制研究

孫會來 李研強(qiáng) 趙良柱 王永濤 王業(yè)森 趙佳俊

摘 要：為了實(shí)現(xiàn)智能車輛最優(yōu)的軌跡跟蹤控制，最大程度的利用滑移率和地面附著系數(shù)實(shí)現(xiàn)智能車輛的動力學(xué)控制，文章提出了考慮滑移率的軌跡跟蹤控制方法。根據(jù)車輛行駛特性，建立動力學(xué)方程，計算運(yùn)動過程中的輪速和橫擺角，并結(jié)合滑移率對車輛動力學(xué)的影響，基于最優(yōu)滑移率設(shè)計了控制系統(tǒng)，以制動工況為例，實(shí)現(xiàn)制動車速工況下的最優(yōu)控制。基于車輛二自由度模型，運(yùn)用Matlab建立二維空間整車運(yùn)動軌跡模型，得到車輛運(yùn)動仿真軌跡。仿真結(jié)果驗(yàn)證了數(shù)學(xué)模型的準(zhǔn)確性和正確性?？紤]滑移率和車輛動力學(xué)的軌跡跟蹤控制更具真實(shí)準(zhǔn)確，文中數(shù)學(xué)模型及設(shè)計的控制系統(tǒng)對車輛跟蹤控制有參考價值。

關(guān)鍵詞：軌跡跟蹤控制;二自由度;滑移率

中圖分類號：V323 ?文獻(xiàn)標(biāo)識碼：A ?文章編號：1671-7988（2020）09-61-04

Research on vehicle trajectory tracking control based on optimal slip ratio^*

Sun Huilai^1，2， Li Yanqiang¹， Zhao Liangzhu²， Wang Yongtao²， Wang Yesen²， Zhao Jiajun²

（?1.Institute of Automation， Qilu University of Technology （Shandong Academy of Sciences?），Shandong Jinan 250101; 2.College of Mechanical and Automotive Engineering， Qilu University of Technology（?Shandong?Academy?of?Sciences?）， Shandong Jinan 250353 ）

Abstract：?In order to achieve the optimal trajectory tracking control of intelligent vehicles， and to maximize the use of slip ratio and ground adhesion coefficient to achieve the dynamic control of intelligent vehicles， a trajectory tracking control method considering slip ratio is proposed in this paper. According to the driving characteristics of the vehicle， the dynamic equation is established， the wheel speed and yaw angle in the process of motion are calculated， and the control system is designed based on the optimal slip rate in combination with the influence of slip rate on the vehicle dynamics. Taking the braking condition as an example， the optimal control under the braking speed condition is realized. Based on the two degree of freedom model of vehicle， a two-dimensional space vehicle motion trajectory model is established by MATLAB， and the vehicle motion simulation trajectory is obtained. The simulation results verify the accuracy and correctness of the mathematical model. The track tracking control considering slip rate and vehicle dynamics is more real and accurate. The mathematical model and control system designed in this paper have reference value for vehicle tracking control.

Keywords：?Tracking control;?Two degree of freedom;?Wheel slip ratio

CLC NO.：?V323??Document Code： A??Article ID： 1671-7988（2020）09-61-04

前言

隨著工業(yè)自動化的迅速發(fā)展，無人駕駛車輛的應(yīng)用逐漸被人們關(guān)注?；诃h(huán)境感知的輔助駕駛技術(shù)或車輛全自動駕駛技術(shù)迅猛發(fā)展，以車輛自主修復(fù)既定軌跡成為核心技術(shù)之一。實(shí)現(xiàn)全自主無人駕駛車輛在高速等復(fù)雜路面安全穩(wěn)定的軌跡跟蹤控制具有十分重要的意義。

根據(jù)軌跡跟蹤控制的技術(shù)研究背景，常見的控制方式有PID控制、自適應(yīng)控制、預(yù)測控制、滑模控制等。例如余卓平^[1]研究的反步法差動轉(zhuǎn)向軌跡跟蹤著重考慮車輛動力學(xué)模型，并未建立二自由度模型。本文采取二自由度模型和車輛動力學(xué)模型相結(jié)合的方法更加準(zhǔn)確直觀地實(shí)現(xiàn)了車輛軌跡跟蹤控制。再如潘世舉^[2]提出的跟蹤誤差法研究車輛軌跡及鄭子驁^[3]提出的反演法軌跡控制技術(shù)都沒有將車輛的滑移率考慮進(jìn)去，與實(shí)際的車輛運(yùn)動狀態(tài)有些許偏差。此外自主駕駛車輛在運(yùn)動過程中受到摩擦和輪胎磨損的原因，在正常行駛時要考慮相應(yīng)的動力學(xué)約束和滑移率等等因素。

因此本文將滑移率作為主要控制參數(shù)建立車輛動力學(xué)模型，通過仿真軟件MATLAB/Simulink搭建基于運(yùn)動學(xué)模型的線性二自由度模型預(yù)測控制算法。線性二自由度模型預(yù)測控制算法相比于非線性模型預(yù)測控制算法具有實(shí)時性好、計算簡便、結(jié)果明了等優(yōu)點(diǎn)，通過Simulink搭建基于運(yùn)動學(xué)模型的線性二自由度模型預(yù)測控制算法，同時考慮了相同的控制參數(shù)在對不同車輛初始位姿下的軌跡跟蹤控制效果也略有不同，因此結(jié)合PID控制，優(yōu)化滑移率以提高車輛的軌跡跟蹤精度，并選取了最有代表性的制動工況進(jìn)行仿真分析。

1 二自由度模型及車輛動力學(xué)模型

1.1 車輛線性二自由度模型

本文的研究是基于二自由度模型，考慮滑移率對車輛運(yùn)動軌跡的影響，并求解出該車的運(yùn)動微分方程。根據(jù)汽車真實(shí)運(yùn)動規(guī)律，結(jié)合PID控制運(yùn)用MATLAB建立一個二維空間整車運(yùn)動軌跡模型。

模型的假設(shè)條件：

（1）忽略車輪、車體和地面的彈性作用;

（2）忽略車輛的俯仰、側(cè)傾和垂向運(yùn)動;

（3）車輛沿X軸的前進(jìn)速度u視為恒定值;

（4）側(cè)向加速度限定在0.4g以下;

（5）不考慮地面的切向力對輪胎側(cè)偏特性的影響;

（6）忽略空氣阻力和滾動阻力的影響;

（7）不考慮載荷轉(zhuǎn)移，車輛的質(zhì)量均勻分布在每個車輪上。

這樣，車輛被簡化成一個單輪車模型。該模型具有側(cè)向及橫擺兩個自由度。

如圖1所示，車輛坐標(biāo)系的縱軸和橫軸分別對應(yīng)圖中的OX軸 和OY軸。在 t 時刻質(zhì)心的速度 v₁在 OX軸、OY 軸上的分量分別是 u、v。因?yàn)檐囕v在轉(zhuǎn)向過程中通常會伴隨著平移和轉(zhuǎn)動兩種動作，所以車輛坐標(biāo)系中的質(zhì)心速度的大小和方向均發(fā)生變化，導(dǎo)致體現(xiàn)在車輛坐標(biāo)系中的縱軸與橫軸數(shù)值也會隨之發(fā)生變化。由此可推導(dǎo)出車輛在絕對慣性坐標(biāo)系下的運(yùn)動方程：

式中φ為車輛的橫擺角度，且。

1.2 汽車動力學(xué)模型

汽車制動時，隨著制動時間的不斷增加，由于車輪抱死，車輪運(yùn)動中，滾動占比會越來越少，同時滑動占比將越來越多。

由于汽車動力學(xué)模型的建立是一個復(fù)雜的過程，所以采用單輪模型建立汽車動力學(xué)模型。簡化的單輪模型如圖2所示。

由圖可得到車輛的動力方程：

車輛運(yùn)動方程：

車輪運(yùn)動方程：

車輛縱向摩擦力：

滑移率的定義：

式中，m為1/4整車質(zhì)量（kg）;F為地面制動力（N）;R為車輪半徑（m）;I為車輪轉(zhuǎn)動慣量（kg·m²）;Tb為制動力矩（N·m）;v 為車身速度（m/s）;ω為車輪角速度（rad·s）;N為地面對車輪的法向反作用力（N）;μ為地面摩擦系數(shù)，v為車輪中心的速度;r為車輪的滾動半徑。

1.3 汽車輪胎制動模型

汽車輪胎模型反映了車輪和地面附著系數(shù)與滑移率之間的關(guān)系。常見的輪胎模型有雙線性模型、Burckhardt輪胎模型和Dugoff輪胎模型等。本文采取應(yīng)用比較廣泛的雙線性輪胎模型，將附著系數(shù)—滑移率曲線簡化為兩段直線。如圖3所示：

汽車制動器模型是指制動系氣液壓力與制動器力矩之間的關(guān)系模型。為了便于研究，假設(shè)仿真的制動器為理想原件，忽略制動器滯后帶來的影響。因此建立制動器方程如下：

式中，Tb為制動器制動力矩（N·m）;K_f為制動器制動因數(shù)（N·m/kPa）;P為制動壓力（kPa）。

由于制動器中各個機(jī)械零部件存在間隙和摩擦，導(dǎo)致制動器滯后，建立制動器滯后系統(tǒng)模型如下：

2 基于二自由度模型的MATLAB/SIMULINK仿真

2.1 控制系統(tǒng)的設(shè)計

本文主要研究基于最優(yōu)滑移率的車輛軌跡控制，采用Simulink及有關(guān)的控制工具箱進(jìn)行最優(yōu)滑移率與不考慮滑移率之間對比以及最優(yōu)滑移率與不考慮車輛動力學(xué)之間的對比的仿真分析，得到車輛軌跡的仿真對比圖以及車速輪速的對比圖，以突出最優(yōu)滑移率對軌跡控制的優(yōu)異性。

模型系統(tǒng)一共分為三大部分，第一部分為被控制對象，也就是車輛動力學(xué)模型;第二部分是汽車運(yùn)動學(xué)模型，在實(shí)際情況中，車速受很多其他因素的影響，不能對其直接控制，所以我們只能依靠調(diào)節(jié)滑移率，從而控制輪速，車速只能通過閉環(huán)控制：利用滑移率的定義求得實(shí)際滑移率，然后與期望滑移率進(jìn)行對比，再進(jìn)行閉環(huán)控制，進(jìn)而控制車速。對制動滑移率的控制就是使制動時滑移率維持在最佳滑移率附近（10%～?30%），以得到最短的制動距離?？刂破髯畛Ｓ玫乃惴ň褪抢帽壤e分微分控制P，只要調(diào)整的PID參數(shù)合適，就可以得到很好的控制效果;第三部分是汽車轉(zhuǎn)向模型，給予車輛一個角度（通過方向盤實(shí)現(xiàn)），利用PID控制^[4]實(shí)現(xiàn)對汽車轉(zhuǎn)向的控制，對車輪轉(zhuǎn)角進(jìn)行二自由度轉(zhuǎn)化，分別在X軸和Y軸顯示相對應(yīng)的角度，然后與對應(yīng)的車速相乘，橫向和縱向車輛軌跡圖，最終實(shí)現(xiàn)對車輛的軌跡控制。

2.2 仿真模型建立

Simulink是MATLAB中的一種可視化仿真工具， 是一種基于MATLAB的框圖設(shè)計環(huán)境，是實(shí)現(xiàn)動態(tài)系統(tǒng)建模、仿真和分析的一個軟件包。利用Simulink搭建車輛軌跡控制的仿真模型，該軌跡跟蹤控制車輛系統(tǒng)參數(shù)見表1。將前輪轉(zhuǎn)角作為系統(tǒng)輸入量，可以使車輛的運(yùn)動狀態(tài)得到更方便的控制，讓車輛盡可能地跟隨預(yù)期的軌跡行駛。由此，可以建立Simulink仿真流程（如圖4所示）。

3 仿真結(jié)果分析

3.1 二維軌跡仿真

根據(jù)車輛參數(shù)進(jìn)行仿真，最佳滑移率設(shè)置為 0.2，整車1/4質(zhì)量為300kg，初始車速為100km/h，以車輛前進(jìn)方向?yàn)閄軸，平行于地面、垂直于前進(jìn)方向?yàn)閅軸，輸入期望軌跡角度為此直角坐標(biāo)系的45°。

由圖5知：相比于不考慮滑移率的控制，考慮滑移率控制的車輛軌跡更加平滑、剎車距離更短，這是因?yàn)殚]環(huán)控制穩(wěn)定的將滑移率控制在10%～30%，使得車輛始終保持較好的車身狀態(tài)。

文中還將最優(yōu)軌跡與不考慮車輛動力學(xué)的車輛軌跡進(jìn)行對比，在不考慮車輛動力學(xué)的仿真模型中，僅簡單的將車速作為一個輸入變量，經(jīng)過PID控制進(jìn)行仿真。兩者對比可以看出考慮動力學(xué)的仿真模型更切合實(shí)際情況。

在初始車速為100公里每小時的前提下，車輛經(jīng)過7.7秒完全停止。且輪速線一直處于車速線下方并靠近車速線，最終在7.7秒兩者同時為零。

3.2 車輛運(yùn)動學(xué)仿真

本文一大特點(diǎn)就是加入一個角度輸入量并利用二自由度轉(zhuǎn)化，生成車輛運(yùn)動軌跡，圖8就是軌跡轉(zhuǎn)角圖。

由圖9可知：實(shí)際滑移率始的數(shù)值終維持在0.2附近波動，符合期望的滑移率。說明了本文的PID控制器發(fā)揮了較好的調(diào)節(jié)作用。

3.3 車輛動力學(xué)仿真

由圖10可知：制動力在閉環(huán)控制中受到最優(yōu)滑移率控制的影響，最終在480N上下波動。

4 結(jié)語

本文通過對車輛進(jìn)行力學(xué)分析，求解出車輛的動力學(xué)及運(yùn)動學(xué)模型;利用MATLAB中的Simulink模塊搭建基于二自由度轉(zhuǎn)化的車輛制動系統(tǒng)的模型，并進(jìn)行了仿真測試;通過對比分析可知：考慮滑移率的車輛行駛軌跡更接近真實(shí)情況，PID控制的使用大大縮短了制動距離，兩者相結(jié)合使車輛運(yùn)動軌跡更加符合預(yù)期。對于車輛跟蹤控制的研究具有理論研究價值與參考意義。

參考文獻(xiàn)

[1] 余卓平，侯譽(yù)燁，熊璐，陳素琴.基于反步法的差動轉(zhuǎn)向無人車輛軌跡跟蹤[J].汽車工程，2019，41（11）：1229-1234+1242.

[2] 潘世舉，李華，蘇致遠(yuǎn)，徐友春.基于跟蹤誤差模型的智能車輛軌跡跟蹤方法[J].汽車工程，2019，41（09）：1021-1027.

[3] 鄭子驁.基于反演法的智能汽車連續(xù)換道軌跡控制技術(shù)[J].自動化與儀器表，2019（01）：129-131.

[4] 秦萬軍，徐友春，李明喜，耿帥，李欣瑩.基于二自由度模型的無人駕駛車輛軌跡跟蹤控制研究[J].軍事交通學(xué)院學(xué)報，2014，16（11）：31- 35.

[5] 趙垚森，朱勇，徐小東.基于Simulink的汽車ABS仿真分析[J].機(jī)電工程，2018，35（12）：1357-1360.

[6] 馬迪.自主駕駛車輛軌跡跟蹤控制研究[D].大連理工大學(xué)，2017.

[7] 喻青濤.基于差力主動轉(zhuǎn)向的電動輪車耦合動力學(xué)控制研究[D].重慶理工大學(xué)，2016.

[8] 李志高.汽車ABS的控制算法與仿真研究[D].武漢理工大學(xué)，2011.

[9] 冉洪亮.基于模型預(yù)測控制算法的無人駕駛車輛路徑識別與跟蹤控制[D].重慶大學(xué)，2018.

[10] 李子龍.基于人工神經(jīng)網(wǎng)絡(luò)的智能汽車循跡控制研究[D].合肥工業(yè)大學(xué)，2019.

[11] 程軍.用MATLAB/SIMULINK進(jìn)行車輛控制系統(tǒng)的設(shè)計[J].汽車研究與開發(fā)，1997（03）：7-10+24.

[12] 劉鑫.發(fā)電機(jī)線棒壓孔機(jī)計算機(jī)監(jiān)控系統(tǒng)的研發(fā)與應(yīng)用[D].大連交通大學(xué)，2011.