移動機器人滑模跟蹤控制

丁恒 王世榮 高正 劉鈞天

摘 要： 針對移動機器人動力學模型，通過線性解耦，將該線性耦合系統解耦成兩個獨立的子系統，使用積分滑模來實現滑模函數的設計，進行相應的穩定性分析。

關鍵詞： 線性解耦；積分滑模；控制器設計

中圖分類號：TP242 文獻標志碼：A 文章編號：2095-2945（2018）33-0035-02

Abstract： According to the dynamic model of mobile robot， the linear coupling system is decoupled into two independent subsystems by linear decoupling， and the sliding mode function is designed using integral sliding mode， and the corresponding stability analysis is carried out.

Keywords： linear decoupling； integral sliding mode； controller design

1 介紹

移動機器人可通過移動來完成一些比較危險的任務，如地雷探測、海底探測、無人機駕駛等，在科研、工業、國防等很多領域都有實用價值。然而，移動機器人是一個多變量、強耦合的欠驅動系統，難以對其進行高性能軌跡跟蹤控制。

本文針對移動機器人動力學模型，通過線性解耦將其轉化為兩個獨立的子系統，分別針對子系統設計了滑模跟蹤控制。仿真結果表明，該控制系統能夠快速跟蹤給定的線速度和參考角度，在工程上有一定的應用價值。

2 動力學模型

2.1 移動機器人動力學模型的建立

假設兩輪獨立驅動剛性移動機器人在平面內移動，如圖1所示，兩個前輪各采用直流伺服電機驅動，通過調節輸入電壓實現驅動輪的速度差。假設絕對坐標OXY固定在平面內，則移動機器人動態特性可用動力學方程來描述。

對于車體，根據力矩平衡原理，車體轉動角度=右輪主動力矩-左輪阻力矩，即

（1）

根據牛頓定律，得

（2）

其中：Iv為繞機器人重心的轉動慣量，Dr和Dl分別為左右輪的驅動力，l為左右輪到機器人重心的距離，？準為機器人的位姿角，v為機器人的線速度。

對于車輪，根據力矩平衡原理， 左右輪的動態特性可用下面方程表示：

（3）

（4）

其中：下標r，l分別表示右輪和左輪，Iw為車輪的轉動慣量，c為車輪輪胎與地面之間的滾動摩擦系數，k為電機的驅動增益，r為車輪半徑，？茲為車輪轉角，ur，ul分別為右輪驅動輸入和左輪驅動輸入。

2.2 系統解耦

針對該系統的控制律設計，必須對系統進行解耦，取

可得到ur=u1-u2，u1=u2，則系統可解耦為以下兩個獨立的子系統：

=a1v+b1u1 （6）

（7）

3 移動機器人控制器設計

3.1 系統式（6）的控制器設計

假設理想線速度vd為光滑的，則定義誤差函數e=vd-v，則線速度誤差動態微分方程為

=d-=d-a1v-b1u1 （8）

設計滑模面如下：

s=e+k1edt （9）

其中，k1>0，通過選擇合適的增益可以使系統的跟蹤指令偏差在一個比較理想的滑模面上滑動至穩定。

考慮如下Lyapunov函數：

V1=S2

則

則 ，即 ，當t→∞時，V1指數收斂，收斂速度取決于參數？姿1值，？姿1越大，收斂越快。

由s→0，可得e→0，則v→vd，即實現線速度跟蹤。

3.2 系統式（7）的控制器設計

假設跟蹤指令為？準d，跟蹤誤差為？準e=？準d-？準，則控制問題為：通過設計控制輸入u2，使系統輸出跟蹤理想的角度，即？準→？準d。

4 Matlab仿真驗證

被控對象取式（11），a1=-0.05，a2=-0.09，b1=0.25 b2=1.67假設期望線速度指令vd=1m/s。期望角度指令？準=sint，線速度初始值為0.5，角度為0.2。取系統（13）中的控制律式（12），設計其控制參數為k1=10，？籽1=5，？姿1=10。設計外環控制律參數為k2=0.1，？籽2=10，內環滑?？刂坡蓞禐閗3=10，？籽3=10，？姿2=10。仿真結果如下。

從圖2、3可知，本文采用的滑模跟蹤控制有效的實現線速度、角度的跟蹤。其均在極短時間內跟蹤上參考軌跡。

5 結論

本文針對移動機器人動力學系統設計了滑模跟蹤控制器，使移動機器人能在極短時間內實現線速度、方向角度的跟蹤。仿真結果表明，受控的移動機器人系統具有良好的軌跡跟蹤性能。

參考文獻：

[1]Loria， Antonio， Janset Dasdemir， and Nohemi Alvarez Jarquin. Leader-follower formation and tracking control of mobile robots along straight paths. IEEE transactions on control systems technology 24.2（2016）：727-732.

[2]Zhang， Yunong， et al. "Inverse-free solution to inverse kinematics of two-wheeled mobile robot system using gradient dynamics method." Systems and Informatics （ICSAI）， 2016，3rd International Conference on. IEEE， 2016.

[3]Miah， M. Suruz， and Wail Gueaieb. Mobile robot trajectory tracking using noisy RSS measurements： An RFID approach. ISA transactions 53.2（2014）：433-443.