潛艇垂直面滑模控制仿真研究

陸斌杰+李文魁+周崗+陳永冰

摘 要：針對潛艇垂直面運動強(qiáng)非線性、耦合性和參數(shù)不確定的特點，分別基于垂直面非線性和線性模型，考慮舵的動態(tài)響應(yīng)，用艏舵控制深度，艉舵控制縱傾角，采用改進(jìn)型趨近律設(shè)計滑模控制器并進(jìn)行了仿真研究。仿真結(jié)果表明，兩類滑?？刂破骶哂辛己玫目刂菩阅芎洼^強(qiáng)的魯棒性，且無明顯抖振。

關(guān)鍵詞：潛艇；滑?？刂?；魯棒性

中圖分類號：U666.1 文獻(xiàn)標(biāo)志碼：A

Research and Simulation of Vertical Plane of Submarine Based on Sliding Control

LU Bin-jie，LI Wen-kui，ZHOU Gang，CHEN Yong-bing

（College of Electrical Engineering，Navy University of Engineering，Wuhan，Hubei 430033，China）

Abstract：Based on the submarine vertical nonlinear model and linear model and considering the rudder dynamic response ，the improved sliding reaching control law was used to design the bow rudder controller and the stern rudder controller in the presence of model of nonlinearity and parameter uncertainty for submarine vertical motion.The bow and stern rudder controller was used to control the depth and the pitch respectively.The simulations were carried and results show that the two control systems have great performance and strong robustness，and have few chattering problem.

Key words：submarine；sliding mode control；robustness

0 引 言

潛艇運動為六自由度空間運動，表現(xiàn)出大慣性、強(qiáng)非線性、各運動平面強(qiáng)耦合的復(fù)雜特點，通常難以獲得精確的數(shù)學(xué)模型，且用于潛艇控制設(shè)計的方程系數(shù)會由于環(huán)境、水深及潛艇狀態(tài)等的變化而變化，使系統(tǒng)工作點偏離設(shè)計狀態(tài)，影響控制效果，使控制器的設(shè)計難度大大增加。

國內(nèi)外眾多學(xué)者基于經(jīng)典控制理論和現(xiàn)代控制理論設(shè)計了潛艇控制器?；诓聢D和根軌跡法設(shè)計的控制器對參數(shù)攝動和擾動魯棒性較差[1]。針對非線性系統(tǒng)的控制問題，多名學(xué)者進(jìn)行了深入研究[2-3]，但控制器結(jié)構(gòu)復(fù)雜，難以實現(xiàn)。通過模糊方法設(shè)計非線性魯棒補(bǔ)償器，一定程度上可以簡化控制器的復(fù)雜度[4]。近年來，滑?？刂疲⊿MC，sliding mode control）對滿足匹配條件的任意攝動和外界干擾具有較強(qiáng)魯棒性，且其算法簡單、響應(yīng)快速、易于過程實現(xiàn)，受到廣泛關(guān)注[5-9]。傳統(tǒng)的滑模控制方法采用極點配置法、最優(yōu)控制等方法設(shè)計線性切換函數(shù)，利用基于邊界層方法的準(zhǔn)滑?？刂平档投墩瘢O(shè)計潛艇垂直面準(zhǔn)滑?？刂破?。潛艇垂直面操縱運動為雙輸入雙輸出過程，深度控制通道與縱傾控制通道相互耦合，可通過解耦處理[10]，在確保魯棒性的情況下也可忽略耦合[11-12]。不同機(jī)動情況下，潛艇水動力差異巨大，對控制模型的設(shè)計和控制器的魯棒性提出較高要求。文獻(xiàn)[13]采用線性化模型研究了潛艇大攻角下的滑模控制，起到了較好地控制效果。同時在不增加模型復(fù)雜度的情況下也可結(jié)合模糊控制等方法設(shè)計滑?？刂破饕越档投墩馵14-16]。

基于以上考慮，為了獲得較為簡潔的滑?？刂破骺刂颇Ｐ颓掖_?？刂葡到y(tǒng)的魯棒性，以便應(yīng)用于工程實踐，本文在潛艇空間標(biāo)準(zhǔn)運動方程的基礎(chǔ)上進(jìn)行簡化，得到了垂直面非線性和線性操縱運動模型。分別進(jìn)行滑?？刂破髟O(shè)計，在無參數(shù)攝動和部分參數(shù)攝動及有無外界干擾情況下進(jìn)行了對比仿真。仿真結(jié)果表明該控制器具有較強(qiáng)的魯棒性和削弱抖振的性能。

1 潛艇設(shè)計模型簡化

坐標(biāo)系、名詞術(shù)語、符號規(guī)則均采用ITTC和SNAME術(shù)語公報的體系[17，18]。固定坐標(biāo)系（定系）E-ξηζ和運動坐標(biāo)系（動系）O-xyz如圖1所示。

1.1 垂直面非線性設(shè)計模型

1）縱向方程

2）垂向方程

3）縱傾方程

3）運動方程

3 仿 真

為驗證控制器的正確性，針對潛艇定深和變深運動控制進(jìn)行了仿真和分析。潛艇仿真方程為完整的非線性運動方程。采用文獻(xiàn)[1]的潛艇參數(shù)。線性控制器和非線性控制器設(shè)計參數(shù)選擇相同，為：kζ=0.1，kθ=0.08，εζ=5，εθ=2，λζ=100，λθ=400，μζ=0.00051，μθ=0.0051，γζ=3，γθ=4，χζ=0.1，χθ=0.05。

潛艇初始航速uc=10kn，初始深度ζ0=100m，指令深度ζd=10m，縱傾角指令θd=5o，初始潛艇已均衡。

分以下三種情況將線性模型控制器的控制效果和非線性模型控制器的控制效果進(jìn)行對比仿真：

1.潛艇參數(shù)無攝動和無外界擾動時，線性模型控制器的控制效果與非線性控制器的控制效果無明顯差異，深度能快速無超調(diào)趨近指令深度，達(dá)到指令深度后沿期望深度穩(wěn)定航行，縱傾符合限制條件。艏、艉舵打舵平滑無抖振，表明操舵合理，控制性能良好，如圖2、圖3所示。endprint

3.無參數(shù)攝動但有外界擾動，為便于分析，任意選取正弦擾動信號：

dζ=50000sin（0.1πt）、dθ=50000cos（0.2πt）

控制器參數(shù)及初始條件不變，控制效果如圖6、圖7所示。經(jīng)測試，當(dāng)外界擾動力量級小于106時，系統(tǒng)仍能保持較好的控制性能，深度仍可快速無超調(diào)到達(dá)穩(wěn)態(tài)，縱傾符合限制條件，舵角出現(xiàn)較小抖振。而當(dāng)擾動量級大于107，兩類控制器控制下的系統(tǒng)均會出現(xiàn)大幅振蕩，舵角出現(xiàn)大幅高頻打舵現(xiàn)象，無法滿足控制條件。

4 結(jié) 論

基于潛艇垂直面非線性和線性模型，忽略艏艉舵之間的耦合，采用艏舵控制深度，艉舵控制縱傾的策略，分別設(shè)計滑模控制器。仿真結(jié)果表明，線性模型控制器和非線性模型控制器在參數(shù)無攝動和有攝動及有無外界干擾情況下控制效果無明顯差異，因此可采用垂直面線性模型設(shè)計垂直面滑?？刂破鳎覟榱舜_保系統(tǒng)的穩(wěn)定性，對控制器參數(shù)的整定優(yōu)化應(yīng)做進(jìn)一步研究，從而既降低了控制器復(fù)雜度，又有提高了控制器的魯棒性，對工程應(yīng)用及研究具有重要意義。

參考文獻(xiàn)

[1] BABAOGLU O K.Design an automatic control system for a submarine[R].AD A-203925，1988.

[2] HWANG C N，Design of Robust Controllers for Manipulators[J].J National Cheng-Kung University：Sci Eng and Med Section，1991，26：213-234.

[3] HEALEY A J，LIENARD D.Multivariable Sliding Mode Control for Autonomous Diving and Steering of Unmanned Underwater Vehicles[J].IEEE J.Oceanic Engin.，1993，18（3）：327-339.

[4] HWANG Cheng-neng，YANG Joe-ming.Design of fuzzy nonlinear robust compensator and its application on submarines[J].Journal of Marine Science and Technology，2003，11（2）：83-95.

[5] SONG F，SMITH S M .A comparison of sliding mode fuzzy controller and fuzzy sliding mode controller[C]// Fuzzy Information Processing Society，2000.N A FIP S .19th International Conference of the North American.2000：480-484 .

[6] NAI O L，CHRISTOPHER E，SARAHK S.On output tracking using dynamic output feedback discrete-time sliding-mode controllers [J].IEEE Transactions on Automatic Control，2007，52（10）： 1975-1981.

[7] CORRADINI M L，LEO T，ORLANDO G.Experinental testing of a discrete-time sliding mode controller for trajectory tracking of a wheeled mobile robot in the presence of skidding effects[J].Journal of Robotic Systems，2002，19（4）：177-188.

[8] HEALEY A J，LIENARD D.Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles [J].IEEE Journal of Oceanic Engineering，1993，18（3）： 327-339.

[9] NAI O L，CHRISTOPHER E，SARAHK S.On output tracking using dynamic output feedback discrete-time sliding-mode controllers [J].IEEE Transactions on Automatic Control，2007，52（10）： 1975-1981.

[10] 羅凱，李俊，許漢珍.潛艇近水面運動的解耦控制[J].海洋工程，1999，17（3）：27-32.

[11] 牟軍，許漢珍.潛艇操縱運動的變結(jié)構(gòu)控制[J].華中理工大學(xué)學(xué)報，1997，25（6）：33-37.

[12] 夏極，胡大斌.潛艇深度終端滑?？刂萍夹g(shù)[J].艦船科學(xué)技術(shù)，2012，34（2）：55-62.

[13] 徐超，劉剛，徐國華，等.基于泵控液壓舵機(jī)的潛艇深度及縱傾控制[J].中國艦船研究，2017，12（2）：116-123.

[14] 潘慧，佘瑩瑩，唐正茂.大攻角時的潛艇操縱控制技術(shù)[J].華中科技大學(xué)學(xué)報，2012，40（5）：46-49.

[15] KIM H-S，SHIN Y-K.Expanded adaptive fuzzy sliding mode controller using expert knowledge and fuzzy basis function expansion for UFV depth control[J].Ocean Engineering，2007，34 （8-9）：1080-1088.

[16] 戴余良，林俊興，苗海，等.潛艇空間機(jī)動的多變量滑模模糊控制[J].武漢理工大學(xué)學(xué)報：交通科學(xué)與工程版，2009，6（33）：1040-1043.

[17] 中國造船編輯部.船舶動力學(xué)詞典[M].上海：中國造船編輯部，1981.

[18] Nomeneclature for Treating the Motion of a submerged Body Through a Fluid[R].SNAME Technical and Research Bulletin 1-5，1952.

[19] 蘇磊，姚宏，杜軍，等.飛行器自適應(yīng)反推Terminal滑模軌跡跟蹤控制[J].系統(tǒng)工程與電子技術(shù)，2014，36（11）：2249-2254.endprint