寧洪斌，?？ィ囆★w，陳善榮，何 亮

(1.吉首大學信息科學與工程學院，湖南 吉首 416000；2.中國聯(lián)合網(wǎng)絡(luò)通信有限公司邵陽市分公司，湖南 邵陽 422000；3.國家電網(wǎng)湖南省電力有限公司湘西經(jīng)濟技術(shù)研究所，湖南 吉首 416000)

機器人誕生是20世紀科學技術(shù)的一大進步.近些年，機器人技術(shù)不斷向智能化、多元化方向發(fā)展.移動機器人集成了傳感器技術(shù)、機械技術(shù)和計算機技術(shù)，是機器人研究中的一個重要分支[1-2].由于移動機器人是一種高度復(fù)雜的非線性系統(tǒng)，導致獲得高精度的移動機器跟蹤結(jié)果十分困難，因此路徑跟蹤精度問題被廣泛關(guān)注[3-9].21世紀以來，移動機器人已被廣泛應(yīng)用于各個領(lǐng)域，并仍具有廣闊的研究和應(yīng)用前景.為了增強移動機器人滑模路徑跟蹤控制的抗干擾能力，提升控制器的動態(tài)性能及路徑跟蹤精度，在前人研究成果的基礎(chǔ)之上，筆者提出了一種基于有界輸入的滑模路徑跟蹤算法.改進的滑模控制器具有更高的跟蹤精度和更好的跟蹤效果，且保證了移動機器人的全局漸近穩(wěn)定路徑跟蹤控制.

1 移動機器人的模型

圖1 移動機器人位姿誤差示意Fig.1 Schematic Diagram of Pose Error of Mobile Robot

獨立雙后輪差動驅(qū)動移動機器人通過2個后輪的不同速度來控制機器人的速度和方向.在移動機器人的工作平面內(nèi)建立直角坐標，其位姿誤差如圖1所示.

根據(jù)圖1所示模型，得到機器人的運動學模型方程和目標軌跡方程分別為

(1)

(2)

然后由坐標基本變換公式，并結(jié)合圖1得到移動機器人的位姿誤差方程

(3)

2 基于反演設(shè)計的滑模路徑跟蹤控制

反演設(shè)計方法的基本思想是，將復(fù)雜的非線性系統(tǒng)分解成不超過系統(tǒng)階數(shù)的子系統(tǒng)，然后為每個子系統(tǒng)分別設(shè)計Lyapunov函數(shù)和中間虛擬控制量，一直后退到整個系統(tǒng)，直至完成整個控制律的設(shè)計.假設(shè)被控對象為

則其基本的反演設(shè)計方法步驟如下：

(ⅰ)定義位姿誤差e1=x1-xd.

墾利油田群位于渤海南部海域，經(jīng)多年開發(fā)，周邊已建立多座平臺和相應(yīng)的海底管線。新油田在開發(fā)研究過程中需對周邊各種依托可能性進行研究，即該稠油與周邊各油田油品摻混后外輸至FPSO或陸上終端儲存。這就需要對各種方案開展實驗，研究摻混不同油品的黏溫特性。若一一開始實驗，會嚴重影響油田的開發(fā)進程，造成不必要的人力和財力浪費。其可行的方法是研究該油田原油摻混黏度相關(guān)規(guī)律，通過計算預(yù)測摻混后黏度數(shù)據(jù)，用于依托海管的計算。

所以

通過設(shè)計控制律，使得系統(tǒng)滿足Lyapunov穩(wěn)定性理論條件[10]，e1和e2以指數(shù)形式漸近穩(wěn)定，從而保證系統(tǒng)具有全局意義下指數(shù)的漸近穩(wěn)定性.

反演控制器的設(shè)計步驟如下：

(8)

(ⅱ)取切換面函數(shù)s1=e1，s2=e2.通過設(shè)計虛擬控制量β，使得

(9)

β=arctan(|m1|/|m2|),v=u2/sinβ.

(ⅴ)取切換面函數(shù)s3=e3，將角速度控制律設(shè)計為

(4)

為了消除干擾，采用低通濾波器Q(s)，

(5)

3 基于有界輸入的改進型滑模路徑跟蹤控制

設(shè)需跟蹤的路徑為φ*(·)=(x*(·),y*(·),θ*(·)).若機器人能夠收斂并遵循約束條件，則可跟蹤路徑.此時定義|v*(t)|，|ω*(t)|的范圍如下：

其中v*(t)和ω*(t)分別為控制輸入線速度和角速度與時間相關(guān)的函數(shù).

根據(jù)移動機器人的模型(1)，如果φ*(·)=(x*(·),y*(·),θ*(·))可跟蹤，那么移動機器人的輸入也必須滿足約束條件(4).也就是說，對于?t≥0，都有

(6)

條件(5)和(6)確保機器人在約束輸入下跟蹤φ*(·)，因此它們是φ*(·)作為可跟蹤軌跡的必要條件.接下來定義

(7)

由于可實現(xiàn)e1,e2→0，因此實現(xiàn)tanh(pe1),tanh(qe2)→0，此時可將(7)式中的減數(shù)分別用m1，m2來替代，并通過設(shè)計虛擬控制量β，使得

(8)

將(8) 式變形，則虛擬控制律和線速度分別設(shè)計為

角速度控制律(4)不變，并采用低通濾波器(5)消除干擾.

在構(gòu)建控制器之后還需要判斷該控制器是否滿足系統(tǒng)的穩(wěn)定性，如果設(shè)計不合理，系統(tǒng)在控制過程中就會產(chǎn)生不穩(wěn)定現(xiàn)象，系統(tǒng)誤差會越來越大，從而導致試驗失敗；因此，穩(wěn)定性分析是十分有必要的.

(9)

設(shè)計切換函數(shù)，使得s1,s2→0.選取等速趨近律，令

(10)

4 仿真分析

圖2 正弦曲線跟蹤效果對比Fig.2 Tracking Effect Comparison of Sine Curve

對改進后的移動機器人路徑跟蹤進行Matlab仿真，初始位姿為(0.4，-0.2，0)，期望軌跡為|xd|=t，|yd|=sin (0.5|xd|).采用基于反演設(shè)計的滑模控制器跟蹤正弦曲線路徑時，取k1=k2=0.3，k3=0.5，q=3；采用基于有界輸入的改進滑?？刂破鞲櫿仪€路徑時，取a=b=1.0，p=q=10.

圖2示出2種不同方法下的跟蹤效果對比.由圖2可見，基于有界輸入的改進控制器在0.2 s內(nèi)就實現(xiàn)了精確的路徑跟蹤，而基于反演設(shè)計的滑模控制器在6.3 s后才實現(xiàn)較準確的路徑跟蹤.這說明基于有界輸入改進法明顯比基于反演設(shè)計法的動態(tài)性能好.

圖3示出x和y方向的跟蹤效果對比.由圖3可見：在x方向上，2種方法的跟蹤效果區(qū)別不大，但基于有界輸入改進法仍然比基于反演設(shè)計法的效果要好；在y方向上，基于有界輸入改進法明顯比基于反演設(shè)計法的動態(tài)響應(yīng)快.

圖4示出控制輸入的線速度和角速度曲線.由圖4可見，2種方法的控制都較平穩(wěn)，相對來說，基于有界輸入改進法的控制輸入更理想.

圖3 x和y方向跟蹤效果對比Fig.3 Tracking Effect Comparison of x and y Direction

圖4 控制輸入的線速度與角速度曲線Fig.4 Linear Velocity and Angular Velocity Curves of Control Input

5 結(jié)語

利用反演設(shè)計的思想設(shè)計了滑?？刂破?，并采用低通濾波器有效地減弱了干擾，提高了系統(tǒng)的魯棒性.由于控制器的動態(tài)性能不理想，因此在此基礎(chǔ)上做了相應(yīng)改進，即給出了有界輸入須滿足的約束條件.實驗結(jié)果表明，在相同的參數(shù)條件下，基于有界輸入的滑?？刂破髟?.2 s內(nèi)就實現(xiàn)了精確的路徑跟蹤，而基于反演設(shè)計的滑?？刂破髟?.3 s才實現(xiàn)較精確的路徑跟蹤.筆者驗證了基于有界輸入改進控制器的可行性和有效性，為更準確、更快速地實現(xiàn)移動機器人跟蹤控制奠定了基礎(chǔ).