沈建森,周徐昌,趙 江
(1.海軍工程大學(xué)兵器工程系,湖北 武漢 430033;2.海軍裝備研究院,北京 100161)
無人水下航行器(Unmanned Underwater Vehicles,UUV)也稱水下機器人,包括遙控式水下航行器(Remotely Operated Vehicles,ROV)和自主式水下航行器 (Autonomous Underwater Vehicles,AUV),在海洋調(diào)查、環(huán)境監(jiān)測、水下工程等民用以及反水雷、遠程偵查、情報收集等軍事領(lǐng)域都有廣泛的應(yīng)用,正越來越多地受到人們的關(guān)注。
在UUV發(fā)展的諸多關(guān)鍵技術(shù)之中,穩(wěn)定、精確的運動控制是1項相當具有挑戰(zhàn)性的工作,因為:①UUV本身是1個六自由度的耦合強非線性對象;②流體動力系數(shù)難以精確獲得,且隨著UUV工作狀態(tài)的變化具有時變性;③復(fù)雜的海洋環(huán)境將對UUV產(chǎn)生海流、海浪等不確定的外部擾動;④UUV負載的變化以及作業(yè)裝置的運動引起系統(tǒng)模型攝動。針對上述問題,眾多國內(nèi)外相關(guān)學(xué)者和技術(shù)人員都在致力于尋求1種對系統(tǒng)不確定性和外部擾動具有良好魯棒性和自適應(yīng)性的UUV運動控制策略,經(jīng)典控制、現(xiàn)代控制以及非線性控制理論和方法都被應(yīng)用于UUV運動控制系統(tǒng)的設(shè)計[1-2]。
UUV采用何種控制方案并沒有固定的模式,需要根據(jù)其外形、用途等具體特點結(jié)合實航試驗結(jié)果進行選取和確定。事實上,自20世紀80年代以來,一些歐美發(fā)達國家在UUV研制中主要采用的也是當前被普遍接受的UUV控制方法是滑模變結(jié)構(gòu)控制?;W兘Y(jié)構(gòu)控制對系統(tǒng)未建模動態(tài)、參數(shù)變化和外部擾動具有很強的魯棒性,且控制系統(tǒng)設(shè)計和物理實現(xiàn)相對簡單、設(shè)計參數(shù)意義明確便于把握和調(diào)整的優(yōu)點。上述優(yōu)點使其成為近乎理想的UUV運動控制方法,眾多相關(guān)學(xué)者和研究人員對UUV滑??刂七M行了深入研究,并取得了豐富的研究成果,本文結(jié)合相關(guān)重要文獻對UUV滑??刂萍夹g(shù)的發(fā)展和研究現(xiàn)狀進行論述和介紹。
變結(jié)構(gòu)控制(Variable Structure Control,VSC)是20世紀50年代由蘇聯(lián)學(xué)者Emelyanov提出的1種非線性反饋控制策略。它最大的特點在于控制的不連續(xù),當系統(tǒng)狀態(tài)穿越狀態(tài)空間的不同區(qū)域時,反饋控制的結(jié)構(gòu)將發(fā)生變化,從而使系統(tǒng)性能達到某個期望的指標?;?刂?Sliding Mode Control,SMC)是指具有滑動模態(tài)的變結(jié)構(gòu)控制,也是通常所指的滑模變結(jié)構(gòu)控制。當系統(tǒng)狀態(tài)到達特定的狀態(tài)超平面,即滑動平面(Sliding Surface)后,通過控制量的切換使系統(tǒng)狀態(tài)在維持滑動平面并漸進趨于平衡點。因此,可以通過設(shè)計滑動模態(tài)獲得滿意的系統(tǒng)動態(tài)品質(zhì),而且滑動模態(tài)對于系統(tǒng)不確定性因素具有很強的魯棒性,對匹配不確定性更是具有不變性。此外,滑??刂葡到y(tǒng)還具有設(shè)計簡單、易于實現(xiàn)的優(yōu)點,被廣泛地應(yīng)用于航空航天、機器人、水下航行器等運動控制中?;W兘Y(jié)構(gòu)控制基本理論可以參考文獻[3-4]。當然,滑??刂埔泊嬖诓蛔?如作為1種基于模型的控制方法,需要較為精確的系統(tǒng)動力學(xué)結(jié)構(gòu),在控制設(shè)計時還要求全狀態(tài)反饋以及獲得系統(tǒng)不確定性的界。另外,不連續(xù)控制輸入引起的抖振(Chattering)現(xiàn)象是限制其實際應(yīng)用的關(guān)鍵問題。
早在1984年,美國學(xué)者Yoerger和Slotine首先將滑??刂谱鳛?種非線性控制策略引入水下航行器的運動控制,用來直接處理UUV的非線性特性[5]。文獻[5]設(shè)計了AUV非線性軌跡跟蹤滑??刂破?研究了流體動力系數(shù)精度和忽略耦合帶來的模型誤差對跟蹤精度的影響。并通過引入滑模面邊界層(Boundary Layer)消除抖振,進而討論了邊界層厚度和參數(shù)不確定性以及跟蹤精度的關(guān)系。之后,Dougherty[6]將Slotine關(guān)于非線性系統(tǒng)滑模控制的研究應(yīng)用于 “MUST”AUV的航行控制系統(tǒng) (Flight Control System)設(shè)計,所設(shè)計的滑??刂破髟趹彝!⑽⑺俸透咚俸叫?種工作狀態(tài)下均取得了良好的仿真性能。
對于具有12個變量的UUV非線性運動方程直接進行控制器設(shè)計是十分復(fù)雜和困難的工作。通常做法是將運動方程分解為水平 (Steering)、垂直(Diving)和軸向(Axial)子系統(tǒng),分別設(shè)計相應(yīng)的控制器。Rodrigues[7]基于AUV水平和垂直非線性模型設(shè)計的滑模控制器對30%的流體動力系數(shù)攝動表現(xiàn)出良好的魯棒性。雖然滑??刂瓶梢灾苯犹幚矸蔷€性模型,對于運動耦合不強且流體動力可以近似由線性形式表達的UUV,如機動性不高的細長體UUV,在典型工作點附近對運動模型進行線性化處理,可以在很大程度上簡化控制系統(tǒng)的分析和設(shè)計過程。Healey[8]采用簡化的線性模型分別設(shè)計了UUV速度、航向和深度滑??刂破?通過極點配置設(shè)計滑動平面,保證了系統(tǒng)的全局漸進穩(wěn)定,并提出基于航路點(Waypoint)和視線角(Line of Sight)的水平路徑跟蹤策略,討論了常值海流對跟蹤精度的影響,所提出的控制方案被成功應(yīng)用于美國海軍研究生院(NPS)研制的“ARISE”AUV,取得了令人滿意的實驗結(jié)果[9]。
矩陣不等式(Linear Matrix Inequality,LMI)是1種多變量線性系統(tǒng)綜合的有力工具,Innocenti[10]對UUV滑模控制和基于LMI的控制系統(tǒng)設(shè)計方法在跟蹤性能和魯棒穩(wěn)定性方面做了比較研究,基于非線性模型的仿真結(jié)果表明:滑??刂祈憫?yīng)較快,對由模型非線性引起的特定不確定性具有更強的魯棒性,而LMI控制器魯棒性相對較弱,但包含的不確定性更廣泛。高階滑模方法(High Order Sliding Mode)通過對常規(guī)滑??刂浦械那袚Q函數(shù)進行微分得到新的切換函數(shù),把不連續(xù)項轉(zhuǎn)移到控制的一階或高階導(dǎo)數(shù)中,從而得到連續(xù)的滑??刂坡?。Salgado-Jimenez[11]將高階滑模引入AUV的運動控制,所設(shè)計的二階滑模深度控制器通過將不連續(xù)轉(zhuǎn)移到控制信號的微分中,有效地消除了抖振,并且在和PD控制以及普通滑??刂频姆抡娼Y(jié)果對比中表現(xiàn)出了更好地控制性能。
UUV控制中面臨的不確定性包括由于建模誤差或模型線性化產(chǎn)生的不確定動態(tài)特性,以及因為流體動力系數(shù)不精確和時變引起的模型參數(shù)不確定。對于前者,在不確定的上界函數(shù)可知的情況下,應(yīng)用滑??刂瓶梢垣@得理想的魯棒性,而對于后者,自適應(yīng)控制(Adaptive Control)的系統(tǒng)參數(shù)在線估計能力可以有效地解決參數(shù)不確定問題。因此,自適應(yīng)控制和滑??刂平Y(jié)合構(gòu)成的自適應(yīng)滑??刂?Adaptive Sliding Mode Control)在保持滑模控制的魯棒性同時還將對UUV航行過程中的參數(shù)或者環(huán)境變化具有自適應(yīng)能力,是當前常見的UUV混合運動控制策略之一。
Cristi[12]將AUV縱向運動方程表示為線性部分和1個有界非線性函數(shù)之和,通過遞推最小二乘自適應(yīng)算法在線估計線性系統(tǒng)參數(shù),以適應(yīng)AUV工作點的變化,并利用滑??刂扑惴ㄑa償系統(tǒng)的不確定動態(tài)特性,取得了理想的仿真效果。水下航行器控制系統(tǒng)中,相對于鰭舵 (Control Surface)的控制,推進器(Thruster)的控制輸入具有較強的非線性特點,對UUV的動力學(xué)特性有重要的影響,Fossen[13]提出的自適應(yīng)滑??刂破魍ㄟ^在線估計算法的基礎(chǔ)上加入1個不連續(xù)切換項,有效地補償了由于ROV螺旋槳推進器非線性引起的系統(tǒng)輸入矩陣不確定性。Yoerger[14]在滑??刂苹A(chǔ)上進行了自適應(yīng)擴展,當由于不確定性變化導(dǎo)致滑模面超出特定的邊界層時自適應(yīng)過程將自動調(diào)整模型參數(shù),進而調(diào)整控制輸入,使滑模面維持在邊界層內(nèi)。實驗表明:所設(shè)計的控制器能有效地估計“RPV”ROV的有效質(zhì)量,并自適應(yīng)調(diào)整的控制輸入使超出邊界層的滑模面重新回到了邊界層內(nèi),取得了良好的軌跡跟蹤效果。
模糊邏輯控制(Fuzzy Logic Control)作為1種智能控制方法,具有不依賴對象數(shù)學(xué)模型、設(shè)計過程能結(jié)合專家經(jīng)驗和對非線性函數(shù)一致逼近的優(yōu)點,能有效地處理UUV運動控制中的強非線性和建模困難的問題。近年來,將滑模控制和模糊控制結(jié)合應(yīng)用于UUV運動控制引起了眾多學(xué)者的研究興趣,按照結(jié)合方式的不同可分為[15]模糊滑??刂?Fuzzy Sliding Mode Control,FSMC)和滑模模糊控制(Sliding Mode Fuzzy Control,SMFC)。FSMC通過在滑??刂浦欣媚:壿嬋峄刂菩盘?從而消除抖振。SMFC基于滑??刂品椒ㄔO(shè)計模糊控制器,利用模糊規(guī)則逼近滑??刂频姆蔷€性切換函數(shù),同時滑模控制可以保證系統(tǒng)的漸進穩(wěn)定并減少模糊規(guī)則數(shù)量。
根據(jù)Pontryagin最大值原理,對于二維系統(tǒng)的時間最優(yōu)控制,存在1條非線性切換曲線(Switching curve),控制輸入在切換曲線的一側(cè)取最大值而另一側(cè)取最小值。Song[16]基于 SMFC設(shè)計了“OEX”AUV的俯仰和航向控制器,利用模糊邏輯逼近切換曲線,并為每條模糊規(guī)則的輸出設(shè)計不同的滑模控制,使控制器在時間最優(yōu)的同時具有滑??刂频聂敯粜浴alasuriya[17]利用滑??刂圃韺⒘A跟蹤問題轉(zhuǎn)化為一階鎮(zhèn)定問題,并根據(jù)直觀的反饋控制策略制定了模糊規(guī)則,用來逼近未知的模型非線性函數(shù)。所設(shè)計的SMFC控制器不需要精確的系統(tǒng)模型,可以處理模型中的不確定性。Shi[18]設(shè)計的FSMC控制器通過利用模糊邏輯實時調(diào)整滑模變結(jié)構(gòu)控制增益方法消除抖振現(xiàn)象。仿真結(jié)果表明:所設(shè)計的AUV縱傾控制器不僅能消除抖振現(xiàn)象,還可以減小系統(tǒng)的穩(wěn)態(tài)誤差。
運動控制對于UUV的發(fā)展無疑具有重要的意義。滑??刂谱鳛楸姸郩UV控制方案中的1種,以其獨特的優(yōu)勢吸引了國內(nèi)外眾多學(xué)者的關(guān)注,并在實際系統(tǒng)中得到了廣泛應(yīng)用。和其他控制理論一樣,滑??刂埔苍诓粩嗟陌l(fā)展,如Terminal滑模、動態(tài)滑模等。通過將滑??刂坪妥赃m應(yīng)、模糊邏輯等控制方法結(jié)合構(gòu)成混合控制器可以克服滑??刂频娜毕?同時獲得更好的控制性能。此外,隨著非線性系統(tǒng)理論的發(fā)展,基于反饋線性化(Feedback Linearization)和反向遞推設(shè)計(Backstepping)的滑模變結(jié)構(gòu)控制方案設(shè)計具有更強的處理UUV的非線性模型和不確定性的能力,正越來越受到人們的重視。
[1]SIDE Z.Advanced control of autonomous under water vehicles[D].Honolulu:University of Hawaii,2004.8-25.
[2]YUH J.Design and controlof autonomous underwater robots:A survey[J].Autonomous Robots,2000,(8):7-24.
[3]高為炳.變結(jié)構(gòu)控制理論及設(shè)計方法[M].北京:科學(xué)出版社,1996.
[4]姚瓊薈,黃繼起,吳漢松.變結(jié)構(gòu)控制系統(tǒng)[M].重慶:重慶大學(xué)出版社,1997.
[5]YOERGER D R,SLOTINE J J.Nonlinear trajectory control of autonomous under water vehicle susing the sliding methodology[C].Proceedings of IEEE OCEANS,1984.588-593.
[6]DOUGHERTY F,SHERMAN T,WOOLWEAVER G,et al.An autonomous underwater vehicle flight control system using sliding modecontrol[C].Proceedings of IEEE OCEANS,1988,4.1265-1270.
[7]RODRIGUES L,TRAVARES P,PRADO M.Sliding mode control of an AUV in the diving and steering planes[C].Proceedings of MTS/IEEE OCEANS,1996,2.576-583.
[8]HEALY A J,LIENARD D.Multivariablesliding mode control for autonomous diving and steering of unmanned underwatervehicles[J].IEEE Journal of Oceanic Engineering,1993,18:327-338.
[9]MACRO D B,HEALEY A J.Commandcontroland experiment results with the NPS ARIES AUVs[J].IEEE Journal of Oceanic Engineering,2001,26(4):466-475.
[10]INNOCENTI M,CAMPA G.Robust control of underwater vehicle:sliding mode control vs.LMI synthesis[C].Proceedings of the American Control Conference,San Diego,1999.3422-3426.
[11]SALGADO J T,SPIEWAK J M,FRAISSE P,et al.A robust control algorithm for AUV:based on a high order sliding mode[C].Proceedings of MTS/IEEE OCEANS,2004.276-281.
[12]CRISTI R,PAPOULIAS FA,HEALY A J.Adaptive sliding mode control of autonomous underwater vehicles in the dive plane[J].IEEE Journal of Oceanic Engineering,1990,15(3):152-160.
[13]FOSSEN T I,SAGATUN S I.Adaptive control of nonlinear underwater robotic systems[C].Proceedings of the IEEEInternational Conference on Robotics and Automation,California,1991.1687-1694.
[14]YOERGER D R,SLOTINE J J.Adaptive sliding control of an experimental underwater vehicle[C].Proceedings of theIEEE International Conferenceon Robotics and Automation,1991.2746-2751.
[15]SONG F,SMITH S.M.A comparison of sliding mode fuzzy controller and fuzzy sliding mode controller[C].Proceedings of The 19thInternational Conference of the North American Fuzzy Information Processing Society,2000.480-484.
[16]SONG F,SMITH S M.Design of sliding mode fuzzy controllers for an autonomous underwater vehicle without system model[C].proceedings of MTS/IEEE Oceans,2000.835-840.
[17]BALASURIYA A,CONG L.Adaptive fuzzy sliding mode controller for underwater vehicles[C].Proceedings of The Forth International Conference on Control and Automation,2003.917-921.
[18]SHI X C,ZHOU J J,BIAN X Q,et al.Fuzzy sliding mode controller for the motion of autonomous underwater vehicle[C].Proceedings of IEEE International Conference on Mechatronics and Automation,2008.466-470.