秦朝宇　李偉　寧君　孫建

摘要：

針對(duì)欠驅(qū)動(dòng)船舶受到外界因素和內(nèi)部不確定狀態(tài)變量的干擾不能沿著期望路徑航行的問(wèn)題，設(shè)計(jì)了基于非奇異終端滑模（Nonsingular Terminal Sliding Mode， NTSM）的自抗擾控制器（Active Disturbance Rejection Controller， ADRC）.引入自抗擾控制技術(shù)，通過(guò)擴(kuò)張狀態(tài)觀測(cè)器實(shí)時(shí)估計(jì)船舶外界和內(nèi)部總干擾；對(duì)船舶Nomoto模型進(jìn)行變形簡(jiǎn)化，將NTSM和指數(shù)趨近律引入到非線性狀態(tài)誤差反饋環(huán)節(jié)，設(shè)計(jì)基于NTSM的ADRC控制律，在保證ADRC優(yōu)點(diǎn)的前提下可減少可調(diào)參數(shù)，提高系統(tǒng)的收斂速度和穩(wěn)態(tài)跟蹤精度；構(gòu)造降維方程，將復(fù)雜的航跡跟蹤控制問(wèn)題轉(zhuǎn)化為易于實(shí)現(xiàn)的航向鎮(zhèn)定問(wèn)題.Simulink仿真結(jié)果表明，利用該控制器船舶能夠快速、精確地跟蹤期望直線和曲線航跡，控制器具有較強(qiáng)的魯棒性.

關(guān)鍵詞：

欠驅(qū)動(dòng)船舶； 終端滑模； 自抗擾控制； 航跡跟蹤

0引言

隨著航海業(yè)的迅速發(fā)展，欠驅(qū)動(dòng)船舶的控制一直是備受關(guān)注的問(wèn)題.[1 ]船舶的欠驅(qū)動(dòng)性是指由于缺少橫向的推動(dòng)裝置，船舶的控制輸入少于航行的自由度.同時(shí)，船舶表現(xiàn)出大慣性、大時(shí)滯、非線性等特點(diǎn)，且在航行時(shí)受到內(nèi)部不確定擾動(dòng)和外界風(fēng)、浪、流的干擾，導(dǎo)致很難設(shè)計(jì)出完全基于船舶模型的控制航跡的方法.因此，有必要對(duì)欠驅(qū)動(dòng)船舶航行時(shí)所受到的擾動(dòng)進(jìn)行更深層次的探索，找到簡(jiǎn)單、實(shí)用的船舶航跡控制方法.

目前，國(guó)內(nèi)外研究人員進(jìn)行了不同程度的研究工作.文獻(xiàn)[2]采用模糊線性化和局部線性化方法近似線性化船舶模型，設(shè)計(jì)滑模控制器實(shí)現(xiàn)船舶航跡跟蹤控制；文獻(xiàn)[3]針對(duì)船舶直線運(yùn)動(dòng)模型和圓形運(yùn)動(dòng)數(shù)學(xué)模型，利用反步法和Lyapunov穩(wěn)定原理，設(shè)計(jì)出具有指數(shù)穩(wěn)定性的控制算法；文獻(xiàn)[4]采用卡爾曼濾波器估計(jì)不確定參數(shù)，設(shè)計(jì)出相應(yīng)的航跡跟蹤控制器.上述文獻(xiàn)中的控制器設(shè)計(jì)均需要精確的數(shù)學(xué)模型，受參數(shù)攝動(dòng)影響較大，有很大的局限性.文獻(xiàn)[5]和[6]設(shè)計(jì)出對(duì)模型參數(shù)不確定以及外界因素干擾均具有魯棒性的非線性滑模和全局指數(shù)穩(wěn)定的自適應(yīng)控制律，實(shí)現(xiàn)了船舶航跡跟蹤控制，但由于在線整定的參數(shù)較多，算法太過(guò)復(fù)雜，不利于工程實(shí)現(xiàn)；文獻(xiàn)[7]結(jié)合線性滑模和反步法設(shè)計(jì)的控制器能實(shí)現(xiàn)考慮外界和內(nèi)部不確定干擾的船舶航跡跟蹤，但計(jì)算過(guò)程復(fù)雜，不利于工程實(shí)現(xiàn)；文獻(xiàn)[8]提出非線性反饋控制律，將非線性迭代滑模技術(shù)與增量反饋相結(jié)合，實(shí)現(xiàn)了船舶直線和曲線航跡精確跟蹤，但由于滑模迭代需要多次對(duì)函數(shù)求微分，很大程度上阻礙了工程應(yīng)用的實(shí)現(xiàn).

本文利用自抗擾控制器（Active Disturbance Rejection Controller， ADRC）中的擴(kuò)張狀態(tài)觀測(cè)器（Extended State Observer， ESO）模塊對(duì)船舶內(nèi)部不確定擾動(dòng)和外界干擾進(jìn)行實(shí)時(shí)估計(jì)，使得系統(tǒng)不需要依賴于精確的船舶數(shù)學(xué)模型；將非奇異終端滑模（Nonsingular Terminal Sliding Mode， NTSM）切換面引入非線性狀態(tài)誤差反饋（NonLinear State Error Feedback， NLSEF）中，結(jié)合指數(shù)趨近律，設(shè)計(jì)出NTSM自抗擾控制律，在保證ADRC優(yōu)點(diǎn)的前提下提高了系統(tǒng)狀態(tài)的收斂速度，改善了系統(tǒng)抖振，減少了可調(diào)參數(shù)，易于工程實(shí)現(xiàn).

1船舶運(yùn)動(dòng)數(shù)學(xué)模型

考慮舵機(jī)系統(tǒng)特性，欠驅(qū)動(dòng)船舶受內(nèi)部擾動(dòng)和外界恒定風(fēng)、流干擾的運(yùn)動(dòng)數(shù)學(xué)模型為

式中：u和v分別為船的前進(jìn)速度和橫向速度；x和y分別為船的縱向位移和橫向位移；φ和r分別為艏向角和轉(zhuǎn)艏角速度；b為控制增益；δ為控制器的輸入信號(hào)，即舵角；-α1r-α2r3為由船舶轉(zhuǎn)向產(chǎn)生的已知干擾項(xiàng)，其中α1=-1T，α2=aT（T為船的追隨性指數(shù)，a是由螺旋試驗(yàn)得到的值）；ω（t）為外界干擾信號(hào)；δr為命令舵角；KE為舵機(jī)控制增益；TE為舵機(jī)時(shí)間常數(shù).[910]

2基于NTSM的ADRC設(shè)計(jì)

2.1NTSM控制算法

滑模變結(jié)構(gòu)是由蘇聯(lián)學(xué)者Emeleyanov和Utkin提出的一種新的控制方法，通過(guò)設(shè)計(jì)切換函數(shù)，使得系統(tǒng)狀態(tài)按照“滑動(dòng)模態(tài)”軌跡運(yùn)動(dòng).由于切換函數(shù)設(shè)計(jì)比較靈活且與系統(tǒng)參數(shù)干擾無(wú)關(guān)，所以變結(jié)構(gòu)控制具有對(duì)參數(shù)變化不靈敏和快速響應(yīng)等優(yōu)點(diǎn).

傳統(tǒng)的終端滑模（Terminal Sliding Mode， TSM）的切換函數(shù)為

由于外界干擾ω（t）未知，影響控制效果，因此可以通過(guò)控制律對(duì)該干擾進(jìn)行限制，減小對(duì)系統(tǒng)的影響.同時(shí)，在式（5）中加入一個(gè)很小的避零常數(shù)α （α>0），防止控制量為0，從而得到新的控制律：

對(duì)系統(tǒng)（3），取終端滑模面（4），在新的控制律（6）的作用下，在有限時(shí)間內(nèi)系統(tǒng)的狀態(tài)變量會(huì)最終到達(dá)終端滑模面，并使得跟蹤誤差在有限時(shí)間內(nèi)收斂到0.[11]

證明將s對(duì)時(shí)間進(jìn)行求導(dǎo)，可得

綜合式（8）和（9）可以看出：采用終端滑模面，φe在有限時(shí)間內(nèi)趨近滑模面，并具有指數(shù)趨近律，提高了系統(tǒng)的收斂速度.考慮到控制律（6）含有ρ（φ·e）-1項(xiàng)，形式比較復(fù)雜，運(yùn)算量大，在保證趨近律的基礎(chǔ)上，簡(jiǎn)化控制律（6）得

式中：h為ESO對(duì)船舶內(nèi)部和外界不確定干擾的實(shí)時(shí)估計(jì)；δESO為ESO對(duì)不確定量的觀測(cè)誤差上界，為較小的可調(diào)參數(shù).式（11）是將ESO，NTSM和指數(shù)趨近律結(jié)合得到的新的控制律，提高了系統(tǒng)的收斂速度，改善了系統(tǒng)的控制效果.本文考慮了舵機(jī)特性 δ·

=KE（δr-δ）/TE.

2.2自抗擾控制算法

自抗擾控制技術(shù)是韓京清先生于20世紀(jì)80年代末開(kāi)創(chuàng)的新型控制技術(shù)，主要包括3部分：（1）跟蹤微分器（TrackingDifferentiator， TD），用于跟蹤輸入信號(hào)和其微分信號(hào)；（2）ESO，用于估計(jì)控制系統(tǒng)的內(nèi)部和外界干擾；（3）NLSEF，為系統(tǒng)的控制律設(shè)計(jì)部分.它的核心思想是通過(guò)ESO實(shí)時(shí)估計(jì)船舶內(nèi)部不確定動(dòng)態(tài)和外界不確定干擾，從而可以不嚴(yán)格依賴對(duì)象及外部干擾模型進(jìn)行補(bǔ)償，以達(dá)到良好的控制效果.圖1為考慮舵機(jī)特性的基于NTSM的ADRC，其中LESO為線性擴(kuò)張狀態(tài)觀測(cè)器.

2.2.2TD

3在風(fēng)、流影響下船舶航跡控制方法

欠驅(qū)動(dòng)船舶在實(shí)際航行過(guò)程中，受風(fēng)、流影響時(shí)，艏向會(huì)與計(jì)劃航跡向形成一個(gè)風(fēng)流壓差角.為實(shí)現(xiàn)船舶航跡控制，可以構(gòu)造降維方程，在確保船舶的航跡偏

差y收斂于0時(shí)，得到一個(gè)期望艏向φd，將φd作為控制器的參考輸入信號(hào)，通過(guò)NTSMADRC使艏向角誤差收斂于0的較小的鄰域內(nèi)，從而使船舶實(shí)際的艏向φ（t）跟蹤期望艏向φd（t），達(dá)到船舶航跡跟蹤控制的目的.

根據(jù)文獻(xiàn)[15]構(gòu)造期望艏向角方程：

式中：Δφ為艏向與航跡向的夾角；φd（t）為期望艏向；φp（t）為計(jì)劃航跡向；參數(shù)k0主要用于壓縮船舶航跡偏差的坐標(biāo)（k0>0）；k1用于加快或減慢航跡收斂速度（k1>0）；k2用于調(diào)整積分速度（k2>0）.

證明：設(shè)σ=Δy

4仿真結(jié)果

以大連海事大學(xué)教學(xué)實(shí)習(xí)船“育龍”號(hào)為對(duì)象，通過(guò)Simulink進(jìn)行仿真.實(shí)船數(shù)據(jù)參考文獻(xiàn)[16].船舶模型初始狀態(tài)和控制器參數(shù)如下：船舶模型參數(shù)K=0.478，T=216，a=30，ω（t）=0.001，v=0.5 m/s，b=K/T；TD模塊中參數(shù)r=30，h=0.05；ESO模塊中參數(shù)γ0=10；控制律中參數(shù)β=0.01，v=13/11， J=0.000 1，δESO=0.000 001；期望艏向角方程參數(shù)k0=0.003，k1=2.5，k2=0.001.

4.1航跡仿真

直線航跡仿真初始條件設(shè)置為：前進(jìn)速度u=7 m/s，φp=0°，航跡偏差Δy=500 m，φ=0°.仿真圖像見(jiàn)圖2.

4.2系統(tǒng)狀態(tài)變量對(duì)比

圖5和6為船舶仿真中艏向角誤差對(duì)比.實(shí)驗(yàn)證明，在定常干擾情況下，非奇異快速終端滑?？刂破鲗?duì)船舶航向的跟蹤效果比傳統(tǒng)線性滑模效果好，誤差收斂時(shí)間短，且誤差能收斂到更小的鄰域區(qū)間內(nèi).

5結(jié)論

由仿真結(jié)果可以看出：當(dāng)船舶受到定常干擾時(shí)，引入非線性滑模切換函數(shù)，能提高系統(tǒng)的收斂速度和跟蹤精度；結(jié)合自抗擾控制器（ADRC）中的擴(kuò)張狀態(tài)觀測(cè)器（ESO）對(duì)船舶狀態(tài)和內(nèi)外總擾動(dòng)進(jìn)行實(shí)時(shí)估計(jì)補(bǔ)償，能改善系統(tǒng)抖振；設(shè)計(jì)的非奇異終端滑模（NTSM）ADRC控制律可調(diào)參數(shù)較少；結(jié)合降維方程，通過(guò)進(jìn)行船舶直線和曲線航跡仿真，在控制器參數(shù)完全不變的情況下船舶能沿著既定的航跡航行，達(dá)到船舶航跡跟蹤控制的目的.Simulink驗(yàn)證了該控制方法具有較強(qiáng)的魯棒性.

參考文獻(xiàn)：

[1]

郭晨， 汪洋， 孫富春， 等. 欠驅(qū)動(dòng)水面船舶運(yùn)動(dòng)控制研究綜述[J]. 控制與決策， 2009， 24（3）： 321329. DOI：10.13195/j.cd.2009.03.3.guoch.012.

[2]周倩， 宋立忠， 姚瓊薈. 基于線性化模型的船舶航跡滑?？刂破鞯脑O(shè)計(jì)[J]. 海軍工程大學(xué)學(xué)報(bào)， 2007， 19（1）： 99104.

[3]HUSA K E，F(xiàn)OSSEN T I. Backstepping designs for nonlinear waypoint tracking of ships[C]. Proceedings of the 4th IFAC Conference on Manoeuvring and Control of Marine Craft MCMC97， Brijuni， Croatia， 1997： 16.

[4]YAN P，JIANDA H，QI S. Tracking control of underactuated surface ships：using unscented Kalman filter to estimate the uncertain parameters[C]//Proceedings of the 2007 IEEE International Conference on Mechatronics and Automation. Harbin， China， 2007： 18841889.

[5]孟威， 郭晨， 孫富春， 等. 欠驅(qū)動(dòng)水面船舶的非線性滑模軌跡跟蹤控制[J]. 哈爾濱工程大學(xué)學(xué)報(bào)， 2012， 33（5）： 585589.

[6]朱齊丹， 于瑞亭， 劉志林. 欠驅(qū)動(dòng)船舶全局K指數(shù)航跡跟蹤的級(jí)聯(lián)反步法[J]. 船舶工程， 2012， 34（1）： 4751. DOI：10.13788/j.cnki.cbgc.2012.01.017.