寇　偉，劉昕暉，陳　偉

(1．吉林大學(xué)機械科學(xué)與工程學(xué)院，130022長春; 2．汽車仿真與控制國家重點實驗室(吉林大學(xué))，130022長春)

?

2自由度鉸接車體車輛越障偏移飽和控制

寇偉1，2，劉昕暉1，2，陳偉1，2

(1．吉林大學(xué)機械科學(xué)與工程學(xué)院，130022長春; 2．汽車仿真與控制國家重點實驗室(吉林大學(xué))，130022長春)

摘要:針對2自由度鉸接車體車輛直線越障偏移問題，建立車輛越障運動的動力學(xué)模型．以后車體繞z軸的角速度、沿y軸速度和前車體相對后車體的橫擺角速度作為被控量，建立誤差運動學(xué)模型，對誤差系統(tǒng)進行穩(wěn)定性和能控性分析．由于凈轉(zhuǎn)向力矩有上限，采用反步法設(shè)計系統(tǒng)的抗飽和控制器，對運動偏移控制中的液壓轉(zhuǎn)向機構(gòu)輸出飽和現(xiàn)象進行抑制．通過計算得到了在偏移控制過程中液壓轉(zhuǎn)向執(zhí)行機構(gòu)的凈輸出力矩隨時間變化的曲線．結(jié)果表明:加入抗飽和控制器后，通過前后車體間的轉(zhuǎn)向液壓系統(tǒng)控制前后車體相對角速度，車輛越障運動時的y向偏移誤差在5 s后收斂至0，前后車體夾角、后車體進方向的偏角也隨時間逐漸收斂至0，車輛沿直線路徑行進，證明抗飽和控制算法能有效地消除越障偏移誤差．

關(guān)鍵詞:2自由度鉸接車體;車輛越障;運動偏移;反步法;飽和控制

輪式移動機械，如輪式裝載機、移動機器人或野外作業(yè)車，通常在復(fù)雜地形下工作，需要輪式移動機械具有良好的越障性能［1－3］．劉昕暉等［4］開發(fā)了一種能被動適應(yīng)復(fù)雜地形的輪胎式多功能車，它是一種全地形移動車輛，由前車體和后車體兩部分組成，前車體通過能產(chǎn)生橫擺和扭轉(zhuǎn)的2自由度鉸與后車體連接［4］，如圖1所示．相比傳統(tǒng)車輛平面運動，2自由度鉸接車體車輛能完成復(fù)雜的三維運動．

圖1　2自由度鉸接車體車輛

在2自由度鉸接車體車輛越障實驗中，發(fā)現(xiàn)其越障過程中有運動方向偏移現(xiàn)象，需要不斷采用方向盤大幅調(diào)整運動方向才能使車輛沿預(yù)定的路徑運動．這種越障運動方向偏移現(xiàn)象使車輛的操控性變得復(fù)雜，駕駛員連續(xù)不斷地操作容易出現(xiàn)失誤造成車輛傾翻．為了發(fā)揮2自由度鉸接車體車輛的使用性能，在環(huán)境惡劣崎嶇的地形下更好工作，需要研究其無人駕駛時的運動控制，如使其沿直線行駛，完成某項作業(yè)任務(wù)或者到達某一預(yù)定位置．

目前，國內(nèi)外有很多關(guān)于鉸接式車輛的運動控制研究［5－7］，其中，Tabatabaei［8］研究了鉸接式車輛基于模糊邏輯理論的控制器設(shè)計，用于消除鉸接式車輛的運動跟蹤誤差．Bigras等［9］建立了采礦鉸接式車輛路徑誤差的動力學(xué)模型，利用中值法將時變非線性系統(tǒng)轉(zhuǎn)化為線性系統(tǒng)，設(shè)計了路徑的反饋控制．Moon等［10］分析了車輛幾何形狀、穩(wěn)定性和安全性，提出了一種新的轉(zhuǎn)向控制算法．上述這些控制方法沒有考慮控制輸入的飽和現(xiàn)象．在實際工程應(yīng)用中，考慮到2自由度鉸接車體車輛自身結(jié)構(gòu)設(shè)計的因素，在運動轉(zhuǎn)向過程中，需要通過液壓轉(zhuǎn)向機構(gòu)進行轉(zhuǎn)向，控制運動路徑．由于液壓缸提供的驅(qū)動力是有限的，當車輪需要的轉(zhuǎn)向角度過大時，液壓缸只能提供恒定的驅(qū)動力，輸出的轉(zhuǎn)向力矩不能達到計算需要的轉(zhuǎn)向力矩，在控制過程中會導(dǎo)致液壓轉(zhuǎn)向機構(gòu)輸出飽和，使實際運動控制路徑和理論計算存在偏差．如果車輛在地形起伏比較劇烈的障礙路面運動時，會造成車體運動中實際的傾角比分析計算的大，容易產(chǎn)生傾翻．所以，研究2自由度鉸接車體車輛運動控制時，需要考慮到控制輸入的飽和現(xiàn)象．

本文首先建立了2自由度鉸接車體車輛的越障動力學(xué)和運動學(xué)模型，然后分析了方程的穩(wěn)定性和能控性．在考慮控制飽和的情況下，利用反步法設(shè)計了控制器，進行2自由度鉸接車體車輛運動控制的研究．

1　車輛越障時的動力學(xué)方程

2自由度鉸接車體車輛的前后車體之間的自由度用橫擺角θ1和扭轉(zhuǎn)角θ2描述，前車體和后車體之間通過萬向鉸鏈連接，車輛轉(zhuǎn)向時，液壓缸提供沿O1O2的轉(zhuǎn)向力FO，前車體平面OW1W2轉(zhuǎn)動，前車體傳動軸與后車體傳動軸夾角即為橫擺角θ1;車輛越過左右非對稱障礙時，前后車體繞后車體傳動軸相對轉(zhuǎn)動產(chǎn)生扭轉(zhuǎn)角θ2，前、后車體驅(qū)動力Ff和Fr分別沿前、后車體傳動軸指向前．前、后車體質(zhì)量為mf和mr，前、后車體長度為Lf和Lr，前、后車體瞬心Of和Or在各自輪軸延長線上，由車體轉(zhuǎn)向特性可知，后車體瞬心Of投影到前車體轉(zhuǎn)動平面與前車體轉(zhuǎn)動瞬心Or重合，前、后車體質(zhì)心在車體投影為Bf和Br，如圖2所示．

圖2　2自由度鉸接車體車輛運動示意

根據(jù)車體幾何關(guān)系，可得

因為2自由度鉸接車體車輛的前后車體為非定常約束，假設(shè)作用在車輪上的地面?zhèn)认蛄ψ銐虼?，車輪運動時無側(cè)滑．牽引力和輪子的滾動阻力的合力在前、后橋中心Pf和Pr點形成兩組力和力矩．當前后車體之間的轉(zhuǎn)向鉸不動時，作用在Pf和Pr點的力矩和作用在輪子上的地面反作用力矩平衡，整個車體結(jié)構(gòu)可以看作是一個剛體．當轉(zhuǎn)向鉸運動時，鉸接車運動可以看作是轉(zhuǎn)向鉸提供了前后車體之間的相對運動．所以鉸接車的運動可以看做是車體的剛體運動和轉(zhuǎn)向鉸內(nèi)部力引起的運動合成．忽略驅(qū)動力傳遞的損耗和液壓轉(zhuǎn)向驅(qū)動裝置的損耗．在動力學(xué)模型中，系統(tǒng)輸入就是牽引力和前后車體之間的液壓轉(zhuǎn)向系統(tǒng)提供的轉(zhuǎn)向力．

當轉(zhuǎn)向鉸不運動時，前后車體為繞各自瞬心的剛體運動，則

前、后車體質(zhì)心在車體上投影Bf和Br到前、后橋中心點Pf和Pr距離?到瞬心距離，則有cosφN≈1，cosφM≈1．

前后車體鉸接點O加速度為

前、后車體Pf點和Pr點加速度為

結(jié)合式(1)～(4)，可得前、后車體Pf點和Pr點角加速度和加速度為

式中，F(xiàn)f和Fr是前、后車體的凈牽引力(即前、后車體牽引力減去滾動阻力)，凈引力會使前、后車體在穩(wěn)態(tài)速度上有加減速．

當2自由度鉸接車體車輛轉(zhuǎn)向機構(gòu)轉(zhuǎn)向時，設(shè)轉(zhuǎn)向機構(gòu)的凈轉(zhuǎn)向力矩為T0(即轉(zhuǎn)向液壓桿輸出的轉(zhuǎn)向力矩減去轉(zhuǎn)向阻力矩)，轉(zhuǎn)向時示意圖如圖3所示．

圖3　2自由度鉸接車體車輛轉(zhuǎn)向示意

轉(zhuǎn)向時，后車體繞Pr點的轉(zhuǎn)向角加速度為

前車體繞Pf點的轉(zhuǎn)向角加速度為

式中，bf和br分別為前、后車體質(zhì)心到前、后橋距離．

式(6)和式(7)相加可得前后車體夾角的角加速度為

通過式(5)和式(8)，可得前車體角加速度為

后車體角加速度為

綜合式(5)和式(8)～(10)，即可得2自由度鉸接車體車輛運動時的動力學(xué)方程．

2　控制系統(tǒng)的誤差動力學(xué)方程

2自由度鉸接車體車輛的非完整約束運動學(xué)方程可以用后車體Pr點速度vr，后車體角速度ωr以及前車體相對后車體的角速度rωf描述．給定鉸接車期望行駛的直線路徑，建立路徑坐標系，x軸沿路徑，z軸垂直后車體平面，y軸符合右手法則．對于鉸接車越障時的直線運動控制，只需要考慮后車體繞z軸的角速度、沿y軸速度和前車體相對后車體的橫擺角速度即可，具體為

式中ω為運動學(xué)方程控制輸入量．

其在平衡點的特征根為λ1，2，3=0，因此，由線性系統(tǒng)的穩(wěn)定性判據(jù)可知，該系統(tǒng)是臨界穩(wěn)定的．這在實際工程中是不允許的，當系統(tǒng)參數(shù)有微小偏移時，其特征值可能變?yōu)閺?fù)平面右半平面的根，必須施加控制．

由控制方程(11)得對應(yīng)的向量場為

通過李括號計算，可得系統(tǒng)能控性矩陣

3　系統(tǒng)的抗飽和控制器設(shè)計

2自由度鉸接車體的直線運動控制中，給定車輛的初始值:后車體繞z軸的轉(zhuǎn)角φ0、沿y軸偏移量y0和前車體相對后車體的橫擺角θ0;采用運動學(xué)控制方程確定車輛相應(yīng)的期望轉(zhuǎn)向角速度ω和期望車速vr．再通過動力學(xué)方程采用速度閉環(huán)控制律求得對應(yīng)的牽引力和前后車體轉(zhuǎn)向力矩，直線運動控制系統(tǒng)示意圖如圖4所示．

圖4　直線運動控制系統(tǒng)

直線運動控制中，如果不要求在前進方向上的位置跟蹤，運動速度變成動力學(xué)方程中的閉環(huán)控制．由于發(fā)動機輸出功率限制，即車輛驅(qū)動力FQ是有上限的，期望運動速度vQ需要在車輛許用的范圍內(nèi)．控制器設(shè)計的主要目標是設(shè)計控制量ω使系統(tǒng)的狀態(tài)誤差參數(shù)［yrφrθ1］隨著時間的推移趨近于平衡點［0 0 0］．考慮到在實際工作中，2自由度鉸接車體車輛轉(zhuǎn)向液壓機構(gòu)的輸出功率一定，故在轉(zhuǎn)向時，凈轉(zhuǎn)向力矩TO有幅值，提供的轉(zhuǎn)向角速度有限制．所以在直線運動控制誤差模型中，控制變量需滿足上限，則實際的控制輸入可以表示為

式中: sat(ωc)為飽和函數(shù)，ωc為控制輸入，ωM為控制輸入的飽和上限．

令x1=yr，x2=［sinφrθ1］T，則式(11)可以表示為式中:

根據(jù)控制方程(12)的結(jié)構(gòu)形式，采用反步法設(shè)計控制器［11］，為了考慮輸入的飽和現(xiàn)象［12－13］，引入虛擬狀態(tài)變量λ1和λ2，且

其中:Δω=ω－ωc，Γ1、Γ2為正定矩陣，虛擬狀態(tài)變量λ1和λ2的初始值為λ1(0)=0，λ2(0)=0．

引入如下的變換:

式中α為虛擬控制．

由式(12)～(14)聯(lián)立可得

取虛擬控制如下:

其中K1的選擇使得

為正定矩陣，則式(15)可寫為

定義李亞普諾夫函數(shù)為

對式(17)求導(dǎo)，并利用式(16)可得

因此，設(shè)計控制輸入ωc為

因為Γ1、Γ2為正定矩陣，利用LaSalle-Yoshizawa理論可得

為了得到x1、x2的收斂性，定義關(guān)于λ的李亞普諾夫函數(shù)為

對式(19)求導(dǎo)可得

如果控制輸入不飽和，則有Δω=0，利用LaSalle-Yoshizawa理論可以證明0，從而可以得到=0，實現(xiàn)系統(tǒng)的漸進穩(wěn)定控制．如果存在飽和現(xiàn)象Δω≠0，為了研究收斂性，式(20)可以寫為

式中: a1、a2為Γ1、Γ2的最小特征值，并且a2＞0．5．對式(21)積分可得

由式(17)可得根據(jù)式(14)、式(17)可得

因此由式(22)～(24)可得

通過式(25)可知，當a1、a2增大時，控制誤差會減小，當足夠大時，有t→∞，x1、x2→0，能保證系統(tǒng)的漸進穩(wěn)定控制．

4　仿真分析

在2自由度鉸接車體車輛越障偏移運動控制中，車體參數(shù)取Lr=Lf=1．2 m，br=bf=0．1 m，mf=5 000 kg，mr=7 000 kg．設(shè)初始速度為勻速運動vr=1．67 m/s，系統(tǒng)的初始參數(shù)選為:［yrφrθ1］=［0．33 m 0．3 rad 0．2rad］，應(yīng)用matlab中的Simulink模塊進行建模仿真分析，沒有加入控制算法時，系統(tǒng)誤差隨時間變化的曲線見圖5．

圖5　未加入控制算法時系統(tǒng)誤差隨時間變化

由圖5可知，初始狀態(tài)車輛運動有微小偏差時，如果不施加控制，即前后車體夾角θ1保持不變，車輛運動時沿y軸向的偏移和后車體進方向的偏角φr隨時間逐漸增大;在考慮到執(zhí)行器飽和的情況下，加入抗飽和控制算法后，可得系統(tǒng)誤差隨時間變化曲線和所需凈轉(zhuǎn)向驅(qū)動力矩的輸出隨時間變化曲線如圖6、7所示．

圖6　加入抗飽和控制算法后系統(tǒng)誤差隨時間變化

圖7　凈轉(zhuǎn)向驅(qū)動力矩輸出隨時間變化

由圖6和圖7可知，加入設(shè)計的抗飽和控制器后，通過前后車體轉(zhuǎn)向液壓系統(tǒng)控制前后車體相對角速度，車輛越障運動時y向偏移誤差在增加到0．58 m后開始收斂，約5 s后，偏移誤差收斂至0，前后車體夾角θ1，后車體進方向的偏角φr也隨時間逐漸收斂至0，凈轉(zhuǎn)向力矩的輸出值也隨之收斂至0，車輛沿直線路徑行進．

5　結(jié)　論

1)本文對2自由度鉸接車體車輛越障偏移控制問題進行了研究．在無控制輸入狀態(tài)下，車輛誤差動力學(xué)模型是臨界穩(wěn)定的，需要施加控制消除越障偏移誤差;在考慮了控制器輸入飽和的基礎(chǔ)上，應(yīng)用反步法設(shè)計了抗飽和控制器．

2)數(shù)值仿真分析表明，在無控制輸入的情況下，當車輛初始運動有微小偏差時，運動偏移誤差趨于發(fā)散，隨著時間的增加，車輛的實際運動路徑和期望路徑的偏離越來越大．

3)在采用抗飽和控制算法后，前后車體夾角、后車體進方向的偏角和后車體偏移誤差均收斂至0，車輛沿期望的路徑運動．

4)計算了在偏移控制過程中液壓轉(zhuǎn)向執(zhí)行機構(gòu)的凈輸出力矩．分析表明，設(shè)計的抗飽和控制器能有效消除越障偏移誤差，實現(xiàn)車輛的直線運動控制．

參考文獻

［1］SHIROMA N，ISHIKAWA S．Nonlinear straight path tracking control for an articulated steering type vehicle ［C］/ / ICROS-SICE International Joint Conference．Piscataway: IEEE，2009: 2206－2211．

［2］TATSUYA Y，KOSUKE K，TAKANORI F，et al．Backward path following control of an articulated vehicle ［C］/ / Proceedings of the 2013 IEEE/SICE International Symposium on System Integration．Piscataway: IEEE，2013: 48－53．

［3］BACHA A R．Line detection and lane following for an autonomous mobile robot［D］．Blacksburg: Virginia Polytechnic Institute and State University，2005．

［4］魏巍，劉昕暉，陳延禮，等．在復(fù)雜環(huán)境中2自由度輪式鉸接車輛的越障能力［J］．吉林大學(xué)學(xué)報(工學(xué)版)，2011，41(5) : 1201－1209．

［5］FANG H，F(xiàn)AN R，THUILOT B，et al．Trajectory tracking control of farm vehicles in presence of sliding［J］．Robotics and Autonomous Systems，2006，54(10) : 828－839．

［6］WESTON P F，POSTLETH W I．Linear conditioning for systems containing saturating actuators［J］．Automatic，2000，36(9) : 1347－1354．

［7］HIROSHIMA U，HIGASHI H．Path following control of articulated vehicle by backward driving［C］/ / International Conference on Control Applications．Piscataway: IEEE，2002: 421－426．

［8］TABATABAEI O．A new desired articulation angle for directional control of articulated vehicles［J］．Proceedings of the Institution of Mechanical Engineers Part K: Journal of Multi-body Dynamics，2012，226(4) : 298－314．

［9］BIGRAS P，PETROV P，WONG T．A LMI approach to feedback path control for an articulated mining vehicle ［C］/ / 7th International Conference on Modeling and Simulation of Electric Machines，Converters and Systems．Piscataway: IEEE，2002: 329－337．

［10］MOON K，LEE S H，CHANG S，et al．Method for control of steering angles for articulated vehicles using virtual rigid axles［J］．International Journal of Automotive Technology，2009，10(4) : 441－449．

［11］ZHOU Jing，WEN Changyun．Adaptive Backstepping Control of Uncertain Systems［M］．Berlin Heidelberg: Springer-Verlag，2008: 189－197．

［12］WESTON P F，POSTLETH W I．Linear conditioning for systems containing saturating actuators［J］．Automatic，2000，36(9) : 1347－1354．

［13］WU Xiongjun，LIN Zongli．Dynamic anti-windup design in anticipation of actuator saturation［J］．International Journal of Robust and Nonlinear Control，2012，24(2) : 295－312．

(編輯楊波)

Obstacle negotiation yawing control of a 2-DOF articulated vehicle with actuator saturation

KOU Wei1，2，LIU Xinhui1，2，CHEN Wei1，2
(1．College of Mechanical Science and Engineering，Jilin University，130022 Changchun，China; 2．State Key Laboratory of Automobile Simulation and Control (Jilin University)，130022 Changchun，China)

Abstract:To solve the problem of line path control when the 2－DOF articulated vehicle surmounting obstacle，the dynamical model is developed，the angle velocityof the rear body rotates about z axis，the velocityalong y axis and yaw velocityof the front body relative to the rear body are chosen as controlled variables，and the error kinematic model of the vehicle is developed，the stability and controllability of system are analyzed．Because the net moment provided by the hydraulic steering mechanism has the amplitude，an anti saturation controller is designed by backstepping method to suppress the output saturation of the hydraulic steering mechanism in the yawing control．After putting the anti-saturation algorithm in the error control system，it is shown that the error in y direction i converges to 0 in 5 seconds，also the angle θ1and φrconverge to 0．The tracking path of vehicle is beeline．The antisaturation algorithm is verified to eliminate the yawing error effectively by the simulation．And the curve of net moment provided by the hydraulic steering mechanism is calculated in the process of the yawing control．

Keywords:2 DOF articulated body; vehicle surmounting obstacle; yawing; backstepping method; saturation control

通信作者:陳偉，chenwei_1979@ jlu．edu．cn．

作者簡介:寇偉(1984—)，女，博士研究生;劉昕暉(1962—)，男，教授，博士生導(dǎo)師．

基金項目:國家自然科學(xué)基金(51405187)．

收稿日期:2015－06－16．

doi:10．11918/j．issn．0367-6234．2016．01．010

中圖分類號:U461．6; TP273

文獻標志碼:A

文章編號:0367－6234(2016) 01－0066－06