非完整輪式車輛路徑跟蹤控制

李小楠，于　浩

(1.中國交通通信信息中心，北京 100011；2.萬華化學集團股份有限公司，山東 煙臺264000)

?

非完整輪式車輛路徑跟蹤控制

李小楠1，于浩2

(1.中國交通通信信息中心，北京 100011；2.萬華化學集團股份有限公司，山東 煙臺264000)

針對非完整輪式車輛路徑跟蹤存在算法復雜的問題，提出一種改進的基于引導角的路徑跟蹤算法；根據設計和實驗中所描述的路徑跟蹤問題，提出一種參數曲線路徑的跟蹤方法。在期望位置建立路徑原點坐標系，同時為角度誤差設計一個引導角，并在路徑坐標系中計算跟蹤控制誤差，利用Backstepping回歸設計理論設計跟蹤控制律和路徑參數變更律，使得側向誤差隨角度誤差收斂。經過仿真實驗，車輛在短暫的跟蹤調整后迅速跟進了預設定路徑，其路徑誤差迅速趨近于零，證明該路徑跟蹤算法的有效性。

路徑跟蹤；運動控制；輪式移動；Backstepping

0　引言

移動控制的建立和使用已經有很長的歷史，其中輪式移動在各種實際應用中最為常見，例如輪式結構的自動導引車(Automatic Guided Vehicle)，被廣泛應用于生產、裝配線以及物流倉庫。目前，圍繞輪式移動控制問題的主要研究方向是軌跡跟蹤和路徑控制跟蹤[1]。路徑跟蹤(Path Following)的目標是控制移動機器人按預先給定的速度跟蹤一條幾何路徑且對所要跟蹤的位置無時間要求；軌跡跟蹤(Trajectory Tracking)的目標是控制移動機器人跟蹤[2]一條以時間為參數的幾何軌線，也可以看作一個虛擬的移動目標，如文獻[3-4]所屬控制移動機器人自適應跟蹤該虛擬目標行進。軌跡跟蹤與路徑跟蹤問題的核心區別在于是否存在時間約束以及是目標跟蹤還是路徑控制。在路徑設計規劃問題中，依據目前參考路徑主要表示方法是基于隱式方程和參數方程2種，相關文獻[5-6]在基于隱式方程表示的參考路徑設計路徑跟蹤控制律，和文獻[7]在基于參數方程表示的路徑設計跟蹤控制律，均存在控制奇異點，如當機器人運動速度方向與路徑法線平行時，即閉環系統不是全局漸近穩定的。而文獻[8-9]所設計的路徑跟蹤控制律實質上仍是軌跡跟蹤控制律。文獻[10-12]對水面船舶路徑跟蹤問題進行了研究，提出了一種制導理論，文獻[13]應用該制導理論設計了基于運動學模型的移動機器人全局路徑跟蹤控制律。

本文研究移動輪式車輛的路徑跟蹤控制問題。受文獻[13]啟發,使用Backstepping回歸設計理論[14],提出一種跟蹤參數曲線路徑的方法，該方法的核心是制導理論，也就是通過角度差的變化，控制移動車輛在移動軌跡中與預設路徑的側向差值變化趨同；此方法有效地規避了傳統基于隱式方程和參數方式表述路徑控制中的奇異點問題；同時，更加突顯了的通過路徑控制實現了路徑跟蹤，避免了通過軌跡跟蹤的理念實現路徑跟蹤控制的問題。

1　空間建模

設計一條幾何曲線作為預設路徑，使得車輛根據預設路徑路徑進行跟蹤行駛，行駛過程無時間要求。如圖1所示，在慣性坐標系OXY中，將Pr作為預設行駛路徑出發點，即原點建立路徑坐標系PrXpYp，其中預設路徑在Pr點處的切線方向為Xp軸，垂直方向為Yp軸。

圖1　車輛的路徑跟蹤

(1)

(2)

(3)

式中，vr為路徑坐標系下的速度表達式，根據上式可確定關系如下：

(4)

(5)

(6)

則實際車輛位置及方向p與預設路徑點位置及方向pr(u)的誤差表達為：

(7)

當預設路徑點Cr(u)為連續函數，則只需設計控制函數使得當t→時有‖pe‖→0，即誤差函數收斂于預設路徑上。

2　路徑跟蹤控制

依據回歸設計理論設計跟蹤控制律和路徑參數變更律，主要通過Backstepping設計實現。

(8)

圖2　引導角示意

將arctan(-ye/L)稱作引導角，在側向誤差ye未收斂時，將

(9)

步驟2：定義θz為實際角度誤差θe和引導角arctan(-ye/L)之差，對時間求導后，表達角度差變化率為：

(11)

(12)

設定控制參數k2>0，則式(11)可表達為：

(13)

(14)

在(0,π/2)區間內，選擇一個角度θx，當|θz|>θx，則存在時間t1滿足t1≥t0≥0，并使得當t>t1時有|θz|<θx。根據姿態和輸入均是有界的，所以在時間t∈[t0,t1]段內，xe，ye與θz有界。

當|θz|<θx時，令cosθx=α，此時有α>0和cosθz>α。根據式(14)，有

式中，β為任意正數。可得到

(15)

因此，當選取角速度：

路徑參數u的更新律為：

同時控制參數的選取滿足Lv<4k2α，則路徑跟蹤誤差收斂。

3　仿真結果分析

以3次 Bezier曲線作為參考路徑。參考路徑的表達式為：

式中，路徑參數u∈[0,1]。各控制點的坐標選取為：

[x0,y0]=[1,1]，[x1,y1]=[6.5,2.8]，

[x2,y2]=[16.8,6.2],[x3,y3]=[5,10]。

經過仿真實驗，路徑跟蹤共用時8.4 s，路徑跟蹤的結果如圖3所示。最終跟蹤上了參考路徑，如圖4所示，跟蹤誤差均收斂至零。車輛運動的角速度如圖5所示。

圖3　路徑跟蹤結果

圖4　路徑跟蹤誤差

圖5　角速度

與文獻[13]的方法相比，本文提出了一種新的路徑曲線的參數表示方法，并給出了參數選取規則及證明，實際上使得路徑跟蹤控制問題延伸擴展為跟蹤參數曲線問題；實驗中，車輛跟蹤上路徑的時間主要源于車輛線速度和角速度，與軌跡跟蹤的時間約束有本質區別；經過一定的調整時間，即車輛行駛一定行程后，車輛跟蹤了上了設定路徑，并持續保持零誤差狀態；細觀察實驗結果，可以發現算法使車輛根據實際位置與預設路徑進行角度和位置計算，從而以自有設定的線速度和角速度調整側向誤差的動態變化率，在路徑跟蹤過程中側向誤差一直趨小，而角度誤差有較大起伏，體現了此算法在控制角度調整中，實現了對位置調整的核心目標，最終使得行進路徑與預設路徑的吻合。

4　結束語

本文基于輪式移動的運動學模型,研究了非完整輪式車輛的路徑跟蹤控制問題，通過用參數曲線描述的參考路徑，然后根據側向誤差和角度誤差的關系設計了引導角，控制表示跟蹤誤差。應用參數曲線的表示方式，使得移動車輛路徑跟蹤可以隨用任意參數表示的路徑進行控制，簡化了控制方法；對于實際路徑，可進行路徑微化處理，將路徑表示為一段段可參數表示的曲線，從而實現車輛路徑跟蹤。仿真結果，驗證了設計的控制律的有效性，但沒將動力驅動作為實驗對象，理想化了動力學模型，為進一步完善研究的實用性，下一步將完善實驗，考慮將研究工作擴展為基于動力學模型的移動車輛的路徑跟蹤控制問題。

[1]DE L A,ORIOLO G,VENDITTELLI M.Control of Wheeled Mobile Robots:an Experimental Overview[J].RAMSETE,Berlin:Springer,2001:181-226.

[2]崔明月，孫棣華，李永福，等.輪子縱向打滑條件下的移動機器人自適應跟蹤控制.控制與決策[J],2013,28(5):664-670.

[3]孫棣華，崔明月，李永福.具有參數不確定性的輪式移動機器人自適應backstepping控制[J].控制理論與應用，2012,29(9):1 198-1 204.

[4]HOU Z G,ZOU A M,CHENG L,et al.Adaptive Control of an Electrically Driven Nonholonomic Mobile Robot via Backstepping and Fuzzy Approach[J].IEEE Transactions on Control Systems Technology,2009,17(4):803-815.

[5]馬保離,霍偉.移動小車的路徑跟蹤與鎮定[J].機器人,1995,17(6):358-362.

[6]孫多青,霍偉,楊梟.含模型不確定性移動機器人路徑跟蹤的分層模糊控制[J].控制理論與應用,2004,21(4):489-494.

[7]王棟耀,馬旭東,戴先中.非時間參考的移動機器人路徑跟蹤控制[J].機器人,2004,26(3):198-203.

[8]苑晶,黃亞樓,孫鳳池.帶拖車移動機器人全局路徑跟蹤控制[J].控制與決策,2007,22(10):1 119-1 124.

[9]YUE M,HU P,SUN W.Path Following of a Class of Non-holonomic Mobile Robot with Underactuated Vehicle Body[J].IET Control Theory & Applications,2010,4(10):1 898-1 904.

[10]BREIVIC M,FOSSEN T I.Path Following for Marine Surface Vessels[C]∥In Proceedings of 2004 MTS/IEEE Oceans Conference,2004:2 282-2 289.

[11]BREIVIC M,FOSSEN T I.Principles of Guidance-based Path Following in 2D and 3D[C]∥In Proceedings of the 44th IEEE Conference on Decision and Control,and the European Control Conference,2005:627-634.

[12]BREIVIC M,FOSSEN T I.Guidance Laws for Planar Motion Control[C]∥In Proceedings of the 47th IEEE Conference on Decision and Control,2008:570 -577.

[13]鄭澤偉,霍偉,諸兵.非完整移動機器人全局路徑跟蹤控制[J].控制理論與應用,2012,29(6):741-746.

[14]KANELLAKOPOULOS I,KOKOTOVIC P V,MORSE A S.Systematic Design of Adaptive Controllers for Feedback Linearizable Systems[J].IEEE Trans on Automatic Control,1991,36(11):1 241-1 253.

李小楠男，(1982—)，碩士，工程師。主要研究方向：智能交通、運輸組織及信息化。

于浩男，(1985—)，博士，工程師。主要研究方向：計算機控制與仿真。

Path Following Control for Nonholonomic Wheeled Vehicls

LI Xiao-nan1,YU Hao2

(1.ChinaTransportTelecommunicationandInformationCenter,Beijing100011,China;2.WanhuaChemicalGroupCo.,Ltd,YantaiShandong264000,China)

An improved path following algorithm based on guidance angle is proposed to reduce the complexity of the nonholonomic wheeled vehicle routing.Based on path tracking described in design and experiment,a parametric curve path tracking method is proposed.In this method,a path origin coordinate system is established in a desired position,a guide angle is designed for the angle error,the tracking errors are calculated in path coordinates,the tracking control law and the path parameter change law are designed based on Backstepping regression design theory,and the lateral error is converged with the angle error.In the simulation experiment,the vehicle quickly follows up the preset path after a short track adjustment,the path error of vehicle is rapidly approaching to zero,which proves the effectiveness of the path tracking algorithm.

path following;motion control;wheeled mobile;Backstepping

10.3969/j.issn.1003-3106.2016.10.19

2016-07-12

TP391.9

A

1003-3106(2016)10-0078-05

引用格式：李小楠，于浩.非完整輪式車輛路徑跟蹤控制[J].無線電工程,2016,46(10):78-82.