姜立標(biāo) 吳中偉
(華南理工大學(xué)機(jī)械與汽車工程學(xué)院, 廣州 510640)
智能車輛是一個(gè)典型的時(shí)延、非線性系統(tǒng),其模型參數(shù)具有不確定性,再加上實(shí)際運(yùn)動(dòng)過(guò)程中外部干擾的存在,其軌跡跟蹤控制器設(shè)計(jì)難度較高。滑??刂凭哂锌焖夙憫?yīng)、對(duì)參數(shù)變化及擾動(dòng)不敏感、無(wú)需系統(tǒng)在線辨識(shí)、物理實(shí)現(xiàn)簡(jiǎn)單等優(yōu)點(diǎn)[1-3],被廣泛應(yīng)用在車輛以及類車機(jī)器人軌跡跟蹤控制等方面[4-5]。
軌跡跟蹤控制技術(shù)一直受到國(guó)內(nèi)外學(xué)者的關(guān)注。在類車機(jī)器人跟蹤控制方面,HUNG等[6]在全向移動(dòng)平臺(tái)上使用自適應(yīng)滑??刂聘櫮繕?biāo)軌跡。KUNAR等[7]基于Backstepping反演控制的方法設(shè)計(jì)四輪機(jī)器人軌跡跟蹤控制律。ASLAM等[8]則使用模糊滑??刂茖?duì)滑移轉(zhuǎn)向車輛進(jìn)行軌跡跟蹤控制。邵俊愷等[9]提出了基于強(qiáng)化學(xué)習(xí)的自適應(yīng)PID路徑跟蹤控制器,實(shí)現(xiàn)無(wú)人駕駛鉸接式車輛的路徑跟蹤控制。隨著智能控制理論的發(fā)展,智能車輛軌跡跟蹤控制方面出現(xiàn)了許多新的控制算法。李兵[10]利用滑模算法和RBF神經(jīng)網(wǎng)絡(luò)算法設(shè)計(jì)車輛的路徑跟蹤控制器,使智能車輛能夠較好地跟蹤期望軌跡。文獻(xiàn)[11-12]結(jié)合模糊算法和神經(jīng)網(wǎng)絡(luò)算法設(shè)計(jì)了車輛軌跡跟蹤控制器。文獻(xiàn)[13-15]則在無(wú)人駕駛車輛上使用模型預(yù)測(cè)控制方法進(jìn)行軌跡跟蹤控制。然而在實(shí)際應(yīng)用中上述算法仍存在限制:模型預(yù)測(cè)算法控制精度較高但在線優(yōu)化耗時(shí)過(guò)長(zhǎng),不能滿足跟蹤控制實(shí)時(shí)性要求;神經(jīng)網(wǎng)絡(luò)算法則需要大量精確數(shù)據(jù)進(jìn)行訓(xùn)練,成本較高[16]。
針對(duì)智能車輛的軌跡跟蹤控制,本文提出一種基于趨近律滑??刂频能壽E跟蹤控制器,通過(guò)特殊函數(shù)和反雙曲正弦函數(shù)的組合,以期系統(tǒng)能夠在任意狀態(tài)都能以較大速度趨近滑模面并且平滑、限制抖振,避免現(xiàn)有趨近律滑??刂期吔俣嚷?、抖振現(xiàn)象較大的缺陷。
智能車輛是一個(gè)集感知、決策、控制、執(zhí)行等功能于一體的綜合系統(tǒng)[17-18],如圖1所示。它集中運(yùn)用了計(jì)算機(jī)、傳感、信息融合、通訊、人工智能及自動(dòng)控制等技術(shù),是典型的高新技術(shù)綜合體。
圖1 智能車輛系統(tǒng)Fig.1 Intelligent vehicle system
軌跡跟蹤控制是決策規(guī)劃系統(tǒng)與運(yùn)動(dòng)控制系統(tǒng)中的一部分,是智能車輛環(huán)境感知和車輛控制之間的橋梁。智能車輛從傳感器中獲取環(huán)境以及車輛信息,通過(guò)決策系統(tǒng)形成期待駕駛行為,接著通過(guò)控制系統(tǒng)對(duì)車輛進(jìn)行控制,使車輛安全地從當(dāng)前位置行駛到目標(biāo)位置。
研究車輛軌跡跟蹤控制的目的是在有限環(huán)境信息和車輛信息情況下,通過(guò)提高智能車輛合理決策和控制能力,形成安全可靠的目標(biāo)駕駛行為,并控制車輛駕駛行為,從而提高駕駛安全性。
假設(shè)車輛運(yùn)動(dòng)過(guò)程為低速運(yùn)動(dòng)過(guò)程,忽略車輪側(cè)向滑動(dòng),車輛在行駛中不出現(xiàn)側(cè)向力,由此建立車輛運(yùn)動(dòng)學(xué)模型,如圖2所示。
圖2 車輛運(yùn)動(dòng)學(xué)模型示意圖Fig.2 Sketch of vehicle kinematics model
圖中,θ為車輛車身與坐標(biāo)系X軸的夾角,φ為等效前輪轉(zhuǎn)角,l為車輛軸距,vf為車輛前軸中心點(diǎn)的速度,(xf,yf)為車輛前輪軸中心坐標(biāo),(xr,yr)為車輛后輪軸中心坐標(biāo)。
為方便計(jì)算,將四輪車簡(jiǎn)化為虛擬的兩輪車,如圖3所示。由幾何關(guān)系得到簡(jiǎn)化前后前輪轉(zhuǎn)角的關(guān)系式
cotα+cotβ=2cotφ
(1)
式中α——外輪轉(zhuǎn)角β——內(nèi)輪轉(zhuǎn)角
圖3 等效前輪轉(zhuǎn)角示意圖Fig.3 Sketch of equivalent front wheel angle
由假設(shè)條件可知,車輛運(yùn)動(dòng)學(xué)模型本身符合非完整性約束條件,即
(2)
由圖2可知
(3)
對(duì)式(3)進(jìn)行求導(dǎo)得
(4)
將式(4)代入式(2),可得
(5)
又由圖2,可得
(6)
將式(6)代入式(5)可得
(7)
由式(4)、式(6)、式(7)得
(8)
所以,對(duì)于前輪轉(zhuǎn)向的車輛,以后軸中點(diǎn)為參考點(diǎn),其連續(xù)的運(yùn)動(dòng)學(xué)方程為
(9)
式中v——后軸中點(diǎn)處速度,其方向垂直于后軸軸線
車輛的位姿可由后輪中點(diǎn)在坐標(biāo)系中的位置以及車輛航向角來(lái)表示,可以描述為ρ=(x,y,θ)。為簡(jiǎn)化表達(dá)式,使用向量q=(v,ω)表示車輛的線速度和角速度控制量。同時(shí)令
則車輛運(yùn)動(dòng)學(xué)方程可以表示為
(10)
假定車輛最大等效前輪轉(zhuǎn)角為φmax,則后軸中點(diǎn)最小的轉(zhuǎn)彎半徑為ρmin,則對(duì)應(yīng)的角速度范圍
如圖4車輛位姿圖所示,用(xc,yc,θc)表示車輛的當(dāng)前位置,(xr,yr,θr)表示參考的目標(biāo)位置,則車輛的位姿誤差為
(11)
圖4 車輛位姿Fig.4 Vehicle position
對(duì)式(11)進(jìn)行微分,結(jié)合式(10)和參考的控制輸入qr=(vr,ωr),可以得到系統(tǒng)誤差的微分方程
(12)
車輛的軌跡跟蹤控制目標(biāo)是尋找到合適的控制輸入q=(v,ω),對(duì)車輛在任意的初始誤差情況下,系統(tǒng)在該控制輸入下,使得誤差pe有界且不斷趨向于0,即
(13)
為了減小軌跡跟蹤的誤差,提出了基于趨近律滑??刂频能壽E跟蹤控制算法,其流程如圖5所示。首先建立車輛運(yùn)動(dòng)學(xué)模型,將參考軌跡與當(dāng)前實(shí)際車輛位姿進(jìn)行位姿誤差分析,并將位姿誤差連同參考車輛速度和角速度輸入到所設(shè)計(jì)的軌跡跟蹤控制器中,從而獲得需要的控制車輛跟蹤參考軌跡的車速和角速度。
山地型軟土散布于我國(guó)廣大山地區(qū)域,山地型軟土由該地域泥灰?guī)r,砂泥巖等巖層的碎粒及分化產(chǎn)物經(jīng)雨水裹挾沉積于嶺腳山澗等地。經(jīng)長(zhǎng)期干濕循環(huán)及沉積作用形成。依據(jù)其成因不同可分為洪水沖擊、自身滑移型與溪流雨水搬運(yùn)型。
圖5 算法流程Fig.5 Algorithm process
反步(Back-stepping)控制設(shè)計(jì)方法因?yàn)榭蓪⒖刂破鞯脑O(shè)計(jì)與基于Lyapunv穩(wěn)定性的證明相結(jié)合、可將高階系統(tǒng)劃分為若干個(gè)低階子系統(tǒng)、控制器結(jié)構(gòu)清晰等特點(diǎn),在非線性系統(tǒng)得到了廣泛的應(yīng)用[19-20]。因此,采用此方法設(shè)計(jì)智能車輛軌跡跟蹤控制的滑??刂魄袚Q函數(shù)。
引理1:對(duì)于任意x∈R并且|x|<∞,有φ(x)=xsin(arctanx)≥0,當(dāng)且僅當(dāng)x=0時(shí)等號(hào)成立。
根據(jù)上述引理設(shè)計(jì)滑模切換函數(shù)。
當(dāng)xe=0時(shí),考察Lyapunov函數(shù)
(14)
對(duì)其求導(dǎo)可得
(15)
令θe=-arctan(vrye),那vryearctan(vrye)≥0,當(dāng)且僅當(dāng)vrye=0時(shí)等號(hào)成立,則
所以只要xe收斂到0且θe收斂到-arctan(vrye),則系統(tǒng)狀態(tài)ye收斂到0。
根據(jù)上述結(jié)論設(shè)計(jì)切換函數(shù)
(16)
通過(guò)控制輸入,使得s1趨向于0,s2趨向于0,即實(shí)現(xiàn)xe收斂到0同時(shí)θe收斂到-arctan(vrye),從而實(shí)現(xiàn)ye趨向于0,θe趨向于0。
對(duì)滑模變結(jié)構(gòu)控制而言,不連續(xù)開(kāi)關(guān)特性會(huì)引起系統(tǒng)的抖振。同時(shí)理想滑模變結(jié)構(gòu)控制系統(tǒng)的假設(shè)條件對(duì)于實(shí)際控制系統(tǒng)不可能完全成立。所以抖振無(wú)法消除而且消除了抖振也就消除了變結(jié)構(gòu)控制的抗攝動(dòng)抗擾動(dòng)的能力,因此,完全消除抖振是不可能的,只能將抖振削弱到一定的范圍[21-22]。
為使系統(tǒng)能快速接近切換面,并且進(jìn)一步改善其抖振現(xiàn)象,采用新型趨近律[23]
(17)
其中
式中0<δ<1,η>0,ε>0 ,δ為fal(s,η,δ)在原點(diǎn)附近正負(fù)對(duì)稱線性段的區(qū)間長(zhǎng)度,并且fal(s,η,δ)為非連續(xù)函數(shù)。
圖6 X軸軌跡跟蹤效果Fig.6 Trajectory tracking effects of X axis
當(dāng)|s|≤δ時(shí),即s接近0時(shí),式(17)第1項(xiàng)可以使得系統(tǒng)趨近速度變大,使得系統(tǒng)狀態(tài)在有限時(shí)間之內(nèi)快速到達(dá)滑動(dòng)面,同時(shí)在滑動(dòng)面附近的fal(s,η,δ)是光滑連續(xù)的,控制輸入的高頻震動(dòng)現(xiàn)象被有效削弱。而且式(17)的第2項(xiàng)也是光滑連續(xù)函數(shù),當(dāng)|s|>δ時(shí),能保證系統(tǒng)狀態(tài)可以較大的速度趨近滑動(dòng)面并且起到平滑和限幅的作用。
令ζ=arctan(vrye),則系統(tǒng)的趨近律可表示為
(18)
整理式(18)可以得到控制律
(19)
為驗(yàn)證上述基于新型趨近律滑膜控制器的控制效果,根據(jù)第2、3節(jié)內(nèi)容在Simulink軟件上搭建被控對(duì)象——智能車輛的運(yùn)動(dòng)學(xué)模型和本文提出的軌跡跟蹤控制器。式(18)中新型趨近律滑??刂茀?shù)設(shè)置如表1所示。
表1 仿真參數(shù)設(shè)置Tab.1 Simulation parameter setting
設(shè)定參考軌跡是目標(biāo)線速度和角速度都是勻速運(yùn)動(dòng)的圓軌跡,取ωr=0.2 rad/s,vr=2 m/s,則v′r=0 m/s2。位姿誤差初始值取pe(0)=(20,6,0)。仿真結(jié)果如圖6所示。
由圖6a可知,在本文趨近律控制和雙冪次趨近律控制下,車輛都能跟蹤到參考的X軸軌跡。但是由圖6b可知,在本文趨近律控制下車輛能較快地跟蹤到參考軌跡,到1.87 s時(shí),X軸誤差絕對(duì)值小于0.020 m;而在雙冪次趨近律控制下直到9.27 s,X軸誤差絕對(duì)值才小于0.020 m,耗時(shí)比前者增加7.40 s。而且本文趨近律在接近滑模面時(shí)趨近速度明顯減慢,能平滑地靠近滑模面;而后者在首次接近滑模面時(shí)具有較大的趨近速度,使系統(tǒng)狀態(tài)穿過(guò)滑模面,仍以一定速度向負(fù)方向繼續(xù)運(yùn)動(dòng),負(fù)向X軸誤差最小值為-4.212 m,隨后才逐漸趨向于0。
同樣由圖7a可知,在本文趨近律和雙冪次趨近律控制下,車輛都能跟蹤到參考的Y軸參考軌跡。由圖7b可知,到1.85 s時(shí)本文趨近律控制下Y軸誤差絕對(duì)值小于0.006 m。而雙冪次趨近律控制下,Y軸誤差先增加然后下降,到7.05 s時(shí),Y軸誤差絕對(duì)值才小于0.006 m,耗時(shí)比前者增加5.20 s,其正向最大Y軸誤差達(dá)到6.236 m,負(fù)向Y軸誤差最小值為-0.829 m,均明顯大于本文趨近律控制的效果。
圖7 Y軸軌跡跟蹤效果Fig.7 Trajectory tracking effects of Y axis
由圖8a可知,兩者都能跟蹤到參考航向角。由圖8b可知,趨近律的趨近速度明顯高于雙冪次趨近律。由圖8c可知,本文趨近律和雙冪次趨近律控制下航向角跟蹤都出現(xiàn)了抖振現(xiàn)象。在前者控制下,負(fù)向航向角誤差最小值為-0.246 rad,正向航向角誤差達(dá)到0.004 rad,到2.31 s,航向角誤差絕對(duì)值小于0.001 rad;而在雙冪次趨近律控制下,負(fù)向航向角誤差最小值為-0.873 rad,正向航向角誤差最大達(dá)到0.296 rad,到8.15 s時(shí),航向角誤差絕對(duì)值小于0.001 rad。由此可知,本文趨近律控制下抖振現(xiàn)象明顯減弱,最大正向和負(fù)向航向角誤差僅為雙冪次趨近律的1.351%和28.178%,到達(dá)航向角誤差絕對(duì)值小于0.001 rad的時(shí)間縮短了5.84 s。
圖8 航向角跟蹤效果Fig.8 Tracking effects of course angle
由圖9可以看出,在本文趨近律滑模控制下,車輛能很快地跟蹤到參考軌跡,反應(yīng)快速準(zhǔn)確。而雙冪次趨近律滑??刂齐m然也能跟蹤到參考軌跡,但是需要行駛更長(zhǎng)的距離才能跟蹤成功。相比之下,本文趨近律的跟蹤效果更好。
圖9 圓軌跡跟蹤Fig.9 Curve following
以智能車輛作為研究對(duì)象,對(duì)其進(jìn)行運(yùn)動(dòng)學(xué)分析,并且提出了基于趨近律自適應(yīng)滑模控制的軌跡跟蹤控制算法,與雙冪次趨近律跟蹤控制算法進(jìn)行圓形軌跡跟蹤Simulink對(duì)比仿真。通過(guò)仿真可知,在本文趨近律滑??刂葡?,系統(tǒng)X軸誤差和Y軸誤差收斂時(shí)間明顯比雙冪次趨近律滑模控制縮短,航向角誤差抖振現(xiàn)象減弱,整體跟蹤效果平滑快速,其結(jié)果驗(yàn)證了基于本文趨近律的滑膜控制算法具備更快的趨近速度,抖振現(xiàn)象明顯削弱,跟蹤效果更優(yōu)。
1劉金琨.滑模變結(jié)構(gòu)控制MATLAB仿真[M].2版.北京:清華大學(xué)出版社,2012.
2劉金琨,孫富春.滑模變結(jié)構(gòu)控制理論及其算法研究與進(jìn)展[J].控制理論與應(yīng)用,2007,24(3):407-418.
LIU Jinkun,SUN Fuchun. Research and development on theory and algorithms of sliding mode control[J].Control Theory & Applications, 2007,24(3):407-418.(in Chinese)
3瞿少成.不確定系統(tǒng)的滑??刂评碚摷皯?yīng)用研究[D].武漢:華中科技大學(xué),2005.
QU Shaocheng. Study on sliding mode control theory and application for uncertain system[D].Wuhan: Huazhong University of Science and Technology, 2005.(in Chinese)
4吳衛(wèi)國(guó),陳輝堂,王月娟.移動(dòng)機(jī)器人的全局軌跡跟蹤控制[J].自動(dòng)化學(xué)報(bào),2001,27(3):326-331.
WU Weiguo, CHEN Huitang, WANG Yuejuan. Global trajectory tracking control of mobile robots[J].Acta Automatica Sinica,2001,27(3):326-331.(in Chinese)
5閆茂德,賀昱曜,吳青云.移動(dòng)機(jī)器人全局軌跡跟蹤的自適應(yīng)滑??刂芠J].微電子學(xué)與計(jì)算機(jī),2006,23(4):97-100.
YAN Maode, HE Yuyao, WU Qingyun. Adaptive sliding mode control for the global trajectory tracking of mobile robots[J]. Microelectronics & Computer, 2006,23(4):97-100.(in Chinese)
6HUNG N,VIET T D,IM J S,et al. Motion control of an omnidirectional mobile platform for trajectory tracking using an integral sliding mode controller[J] .International Journal of Control , Automation and Systems,2010,8(6):1221-1231.
7KUNAR U,SUKAVANAM N. Backstepping based trajectory tracking control of a four wheeled mobile robot[J]. International Journal of Advanced Robotic Systems,2008,5(4):403-410.
8ASLAM J,QIN Shiyin, ALVI M A. Fuzzy sliding mode control algorithm for a four-wheel skid steer vehicle[J]. Journal of Mechanical Science and Technology, 2014,28(8):3301-3310.
9邵俊愷,趙翾,楊玨,等.無(wú)人駕駛鉸接式車輛強(qiáng)化學(xué)習(xí)路徑跟蹤控制算法[J/OL].農(nóng)業(yè)機(jī)械學(xué)報(bào),2017,48(3):376-382.http:∥www.j-csam.org/jcsam/ch/reader/view_abstract.aspx?flag=1&file_no=20170348&journal_id=jcsam. DOI:10.6041/j.issn.1000-1298.2017.03.048.
SHAO Junkai,ZHAO Xuan,YANG Jue,et al. Reinforcement learning algorithm for path following control of articulated vehicle[J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2017,48(3):376-382.(in Chinese)
10李兵.基于聯(lián)合仿真的智能車輛路徑跟蹤控制研究[D].大連:大連理工大學(xué),2014.
LI Bing. Research of intelligent vehicle trajectory tracking control based on collaborative simulation[D].Dalian:Dalian University of Technology,2014.(in Chinese)
11楊君,馬戎,劉婷,等.基于模糊神經(jīng)網(wǎng)絡(luò)的智能車輛路徑跟蹤[J].計(jì)算機(jī)仿真,2012,29(7):368-371.
YANG Jun,MA Rong,LIU Ting,et al.Path tracking of intelligent vehicle based on fuzzy neural network[J].Computer Simulation, 2012,29(7):368-371.(in Chinese)
12張琨,崔勝民,王劍鋒.基于模糊神經(jīng)網(wǎng)絡(luò)的智能車輛循跡控制[J].汽車工程,2015,37(1):38-42,77.
ZHANG Kun,CUI Shengmin,WANG Jianfeng. Path tracking control of intelligent vehicle based on fuzzy neural network[J].Automotive Engineering, 2015,37(1):38-42,77.(in Chinese)
13FITRI Y, YASUCHIKA M. Autonomous ground vehicle of path following control through model predictive control with feed forward controller [C]∥12th International Symposium on Advanced Vehicle Control, 2014: 603-610.
14龔建偉,姜巖,徐威.無(wú)人駕駛車輛模型預(yù)測(cè)控制[M].北京:北京理工大學(xué)出版社,2014.
15李培新,姜小燕,魏燕定,等.基于跟蹤誤差模型的無(wú)人駕駛車輛預(yù)測(cè)控制方法[J/OL].農(nóng)業(yè)機(jī)械學(xué)報(bào),2017,48(10):351-357.http:∥www.j-csam.org/jcsam/ch/reader/view_abstract.aspx?flag=1&file_no=20171045&journal_id=jcscam.DOI:10.6041/j.issn.1000-1298.2017.10.045.
LI Peixin,JIANG Xiaoyan,WEI Yanding,et al. Predictive control of autonomous vehicle based on tracking-error model[J/OL]. Transactions of the Chinese Society for Agricultural Machinery, 2017,48(10):351-357.(in Chinese)
16段建民,夏天,宋志雪.基于聯(lián)合仿真的智能車路徑跟蹤控制研究[J].計(jì)算機(jī)仿真,2017,34(6):129-134,151.
DUAN Jianmin,XIA Tian,SONG Zhixue. Intelligent vehicle based on co-simulation[J]. Computer Simulation, 2017,34(6):129-134,151.(in Chinese)
17周勇. 智能車輛中幾個(gè)關(guān)鍵技術(shù)研究[D].上海:上海交通大學(xué), 2007.
ZHOU Yong.Several key problems research of the intelligent vehicle[D].Shanghai:Shanghai Jiao Tong University,2007.(in Chinese)
18王科.城市交通中智能車輛環(huán)境感知方法研究[D].長(zhǎng)沙:湖南大學(xué),2013.
WANG Ke. Environment perception method of intelligent vehicle in urban traffic[D].Changsha:Hunan Unversity,2013.(in Chinese)
19田聰玲.基于反步法的四旋翼飛行器非線性控制[D].哈爾濱:哈爾濱工業(yè)大學(xué),2014.
TIAN Congling. Nonlinear control of quadrotor based on backsteeping[D].Harbin:Harbin Institute of Technology,2014.(in Chinese)
20任慧榮.類車移動(dòng)機(jī)器人軌跡跟蹤控制方法研究[D].天津:天津大學(xué),2008.
REN Huirong. Research on trajectory tracking control methods of car-like mobile robot[D].Tianjin:Tianjin University,2008.(in Chinese)
21李慧潔, 蔡遠(yuǎn)利. 基于雙冪次趨近律的滑??刂品椒╗J].控制與決策,2016,31(3):498-502.
LI Huijie,CAI Yuanli. Sliding mode control with double power reaching law[J]. Control and Decision,2016, 31(3):498-502.(in Chinese)
22張合新,范金鎖,孟飛,等.一種新型滑??刂齐p冪次趨近律[J].控制與決策,2013,28(2):289-293.
ZHANG Hexin, FAN Jinsuo, MENG Fei,et al. A new double power reaching law for sliding mode control[J]. Control and Decision, 2013,28(2):289-293.(in Chinese)
23周濤.基于一種新型趨近律的自適應(yīng)滑??刂芠J].控制與決策,2017,31(7):1335-1338.
ZHOU Tao. Adaptive sliding control based on a new reaching law[J]. Control and Decision, 2017,31(7): 1335-1338.(in Chinese)