船舶航跡跟蹤的滑模控制

邢道奇 張良欣

（海軍工程大學(xué) 后勤指揮與工程系 天津 300450）

0 引 言

由于對(duì)船舶控制要求的不斷提高，船舶航向控制已經(jīng)不能滿(mǎn)足實(shí)際需要，從而促使航跡跟蹤控制研究成為船舶控制的研究熱點(diǎn)。

根據(jù)期望航跡是否為時(shí)間的函數(shù)，船舶航跡跟蹤可分為路徑跟蹤 （path tracking）和軌跡跟蹤（trajectory tracking）。路徑跟蹤不需考慮時(shí)間的靜態(tài)幾何位置跟蹤，而軌跡跟蹤則要求實(shí)時(shí)跟蹤時(shí)變的期望軌跡，其跟蹤控制的實(shí)現(xiàn)比路徑跟蹤困難得多［1］。同時(shí)，由于船舶運(yùn)動(dòng)具有慣性大、非線(xiàn)性、模型參數(shù)不確定以及存在擾動(dòng)等特點(diǎn)，因此船舶航跡控制成為了一個(gè)非線(xiàn)性問(wèn)題，若采用線(xiàn)性的船舶模型，則會(huì)對(duì)航跡跟蹤控制性能產(chǎn)生影響，難以滿(mǎn)足控制要求。故本文采用非線(xiàn)性船舶模型進(jìn)行船舶軌跡跟蹤控制器設(shè)計(jì)。

滑模控制器因其具有對(duì)系統(tǒng)參數(shù)攝動(dòng)和外界干擾的強(qiáng)魯棒性，以及控制計(jì)算量小、實(shí)時(shí)性強(qiáng)、快速性好等特點(diǎn)，在解決船舶非線(xiàn)性控制問(wèn)題上，得到了廣泛地運(yùn)用［2，3］。 本文將滑模控制方法［4］引入到船舶軌跡跟蹤控制中，采用指數(shù)趨近律進(jìn)行滑模控制器設(shè)計(jì)，對(duì)動(dòng)態(tài)直線(xiàn)軌跡和環(huán)形軌跡的跟蹤控制進(jìn)行了仿真試驗(yàn)，以驗(yàn)證所設(shè)計(jì)的滑模控制器的有效性。仿真結(jié)果表明：滑模控制器的軌跡跟蹤控制性能良好，能精確跟蹤船舶航跡。

1 船舶非線(xiàn)性數(shù)學(xué)模型［5］

雖然船舶在海洋中實(shí)際運(yùn)動(dòng)時(shí)通常具有6個(gè)自由度，但是，對(duì)大多數(shù)船舶運(yùn)動(dòng)及其控制問(wèn)題而言，僅考慮3個(gè)自由度的平面運(yùn)動(dòng)是可行的。因此，本文以船舶平面運(yùn)動(dòng)方程為基礎(chǔ)，研究船舶軌跡控制問(wèn)題。

向量 η=［x，y，ψ］T表示地球 NED 坐標(biāo)系中船舶的位置和首向角，向量 v=［u，v，r］T表示船體坐標(biāo)系中船舶的縱向速度、橫向速度和首向角速度。

地球NED坐標(biāo)系和船體坐標(biāo)系之間轉(zhuǎn)換的運(yùn)動(dòng)學(xué)方程為：

船體坐標(biāo)系中的船舶平面運(yùn)動(dòng)方程為：

其中，坐標(biāo)系轉(zhuǎn)換矩陣為：

科氏和向心力矩陣為：

阻尼矩陣為：

式中：τ=［τ1，τ2，τ3］T分別是縱向和橫向推進(jìn)力和轉(zhuǎn)向力矩的控制輸入，c1=（m-Yv˙）v+（mxg-Yr˙）r，c2=m-Xu˙，xg為船體坐標(biāo)系中船舶重心在x軸方向上的坐標(biāo)值，Xu、Xu˙、Yv、Yv˙、Yr、Yr˙、Nv、Nr、Nv、Nr、Iz為船舶水動(dòng)力參數(shù)。

定義地球坐標(biāo)系中的動(dòng)態(tài)期望軌跡為：xd（t）、yd（t）和 ψd（t）分別為 t時(shí)刻船舶的期望位置和首向角。

2 航跡跟蹤的滑模控制器設(shè)計(jì)

2.1 滑模控制器設(shè)計(jì)

由式（1）可得：

將式（4）代入式（2）中，船舶動(dòng)力學(xué)方程變?yōu)椋?/p>

定義軌跡跟蹤誤差量［5］為：

假設(shè)期望軌跡 ηd，和光滑且有界，定義虛擬期望軌跡為：

式中：Δ＞0為正定的設(shè)計(jì)對(duì)角矩陣。

設(shè)計(jì)船舶跟蹤控制的滑模面為：

由式（5）、（9）得：

定義滑模控制規(guī)律為［3］：

式中：τe為等效控制，τs為切換控制。

為了快速到達(dá)滑模面，考慮指數(shù)趨近律：

式中：設(shè)計(jì)控制矩陣 K=diag{k1，k2，k3}；

由式（10）～（13）可得切換控制為：

由式（11）、（12）、（14）得滑模控制器控制規(guī)律為：

由式（15）可設(shè)計(jì)船舶航跡跟蹤的控制框圖，如下頁(yè)圖1所示。

圖1 船舶航跡跟蹤的控制框圖

2.2 穩(wěn)定性分析

定義 Lyapunov 函數(shù)［4，6］為：

由于慣性矩陣M是正定的，由推導(dǎo)可知M·（ψ）是可逆的，則式（10）變?yōu)椋?/p>

將式（15）代入上式可得：

設(shè)計(jì)參數(shù)矩陣 K=diag{k1，k2，k3}和 ε=diag{ε1，ε2，ε3}是 3×3正定對(duì)稱(chēng)矩陣，可得：

即對(duì)于船舶運(yùn)動(dòng)非線(xiàn)性方程式（1）、（2），設(shè)計(jì)其滑動(dòng)模態(tài)，如式（9）；相應(yīng)的滑模控制規(guī)律為式（15），則滑動(dòng)模態(tài)是漸近穩(wěn)定的，且跟蹤誤差趨于0。

3 仿真試驗(yàn)

以挪威科技大學(xué)全驅(qū)動(dòng)模型船CybershipⅡ?yàn)榉抡鎸?duì)象［7］，采用圖1所示的控制規(guī)律，對(duì)其進(jìn)行航跡跟蹤控制仿真，模型船主要參數(shù)見(jiàn)表1。

滑模控制器參數(shù)設(shè)計(jì) 為：Δ=diag{15，15，15}，K=diag{1，1，1}，ε=diag{0.01，0.01，0.01}

3.1 仿真試驗(yàn)1

選擇期望軌跡為：ηd=［t，t，0］T， 船舶初始狀態(tài)

12為：η0=［80 m，10 m，20°］T。 即期望軌跡相當(dāng)于模型船以0°的首向角，沿直線(xiàn)Y=X航行。由圖2、3可看出船舶能夠較好地跟蹤期望軌跡，控制效果良好。

表1 模型船主要參數(shù)

圖2 船舶軌跡跟蹤曲線(xiàn)

圖3 首向角的跟蹤誤差

圖4 船舶軌跡跟蹤曲線(xiàn)

圖5 位置X的跟蹤比較

3.2 仿真試驗(yàn)2

在仿真中，給定期望軌跡為：

圖6 位置X的跟蹤誤差

圖7 位置Y的跟蹤誤差

式中：ud＝2 m/s、vd=0 m/s、rd=0.01π（rad/s），即期望軌跡相當(dāng)于模型船以2 m/s的速度、沿半徑為200/π（m）的圓航行，初始位置設(shè)為：η0=［-10 m，10 m，10°］T。

從圖4～8可看出，船舶可快速精確跟蹤期望軌跡，使跟蹤誤差趨近于0，跟蹤控制性能良好。下頁(yè)中圖9～11是船舶縱向、橫向控制力和首向角力矩曲線(xiàn)。從中可以看出，控制輸入經(jīng)過(guò)較大調(diào)整后，快速趨近于相對(duì)穩(wěn)定的狀態(tài)。但是由于滑模控制固有的局限，控制輸入出現(xiàn)了抖振。如何抑制軌跡跟蹤控制中的抖振是今后研究中需要解決的問(wèn)題。

4 結(jié) 語(yǔ)

本文建立了全驅(qū)動(dòng)船舶非線(xiàn)性平面運(yùn)動(dòng)方程，設(shè)計(jì)了船舶軌跡跟蹤的滑模控制器，以全驅(qū)動(dòng)模型船Cybership II為仿真對(duì)象，對(duì)2種期望動(dòng)態(tài)軌跡跟蹤控制進(jìn)行了仿真試驗(yàn)，仿真結(jié)果驗(yàn)證了滑模控制器的有效性，跟蹤控制性能良好。

［1］郭晨，汪洋，孫富春，等.欠驅(qū)動(dòng)水面船舶運(yùn)動(dòng)控制研究綜述［J］.控制與決策.2009，24（3）：321-329.

［2］Fahimi F.Sliding-Mode Formation Control for Underactuated Surface Vessels［J］.IEEE TRANSACTIONS ON ROBOTICS.2007，23（3）：617-622.

［3］Alfaro-Cid E，Mcgookin E W，Murray-Smitha D J，et al.genetic algorithmsoptimization ofdecoupled Sliding Mode controllers：simulatedandreal results ［J］. Control Engineering Practice.2005，13：739-748.

［4］胡躍明.變結(jié)構(gòu)控制理論與應(yīng)用［M］.北京：科學(xué)出版社，2003.

［5］Fossen T I.Marine Control Systems：guidance，navigation and control of ships，rigs and underwater vehicles ［M］.Trondheim，Norway：Marine Cybernetics，2002.

［6］高為炳.變結(jié)構(gòu)控制理論基礎(chǔ)［M］.北京：科學(xué)技術(shù)出版社，1990.

［7］Skjetne R.The Maneuvering Problem［D］.Norwegian University of Science and Technology，2005.