紀 興，蘇玉民，張國成

（哈爾濱工程大學 水下智能機器人國防科技重點實驗室，哈爾濱 150001）

帶有死區(qū)補償?shù)那夫?qū)動AUV深度控制

紀 興，蘇玉民，張國成

（哈爾濱工程大學 水下智能機器人國防科技重點實驗室，哈爾濱 150001）

由于舵槳聯(lián)合操控的水下機器人舵機傳動系統(tǒng)死區(qū)非線性的存在，嚴重影響了某水下機器人的深度控制效果。文章以該水下機器人為研究對象，同時考慮了其欠驅(qū)動的運動特性及外界有界干擾和模型參數(shù)攝動,設(shè)計了具有自適應(yīng)補償功能的PID控制器，利用Lyapunov穩(wěn)定性理論，證明在該控制器作用下，該控制系統(tǒng)是全局穩(wěn)定的。最后進行了仿真實驗。實驗結(jié)果表明該控制器具有很好的控制效果，是行之有效的。

欠驅(qū)動AUV；深度控制；自適應(yīng)控制；死區(qū)補償

0 引 言

海洋蘊藏著豐富的資源和能源，在海洋利用與開發(fā)的過程中，水下機器人起著至關(guān)重要的作用[1-4]。某型微小型水下機器人為舵槳聯(lián)合操控機器人[5]，其典型的特征為：執(zhí)行機構(gòu)只有一個主推螺旋槳，一對垂直舵和一對水平舵。它通過推進器提供前進所需的推力，通過垂直舵來控制前進的方向，通過水平舵來控制深度和縱傾。在垂直面內(nèi)，由一個水平舵同時控制深度和縱傾兩個自由度，屬于欠驅(qū)動型水下機器人[6]。這種欠驅(qū)動水下機器人的舵機系統(tǒng)的驅(qū)動電機與從動部分（舵）不是直接接觸的，而是采用了蝸輪蝸桿連接，這就產(chǎn)生了間隙。如果不能消除間隙的影響，間隙就會使負載暫時失控，對驅(qū)動單元產(chǎn)生沖擊，從而導致穩(wěn)態(tài)誤差和時滯，限制了機器人系統(tǒng)的動態(tài)性能和穩(wěn)定精度并產(chǎn)生機械部件的附加磨損。

水下機器人的深度控制精度是其重要的技術(shù)指標之一，關(guān)系到其是否能夠安全有效地完成作業(yè)任務(wù)[7]，很多學者對此做了大量的研究，取得了很多寶貴的研究成果[8-15]。舵槳聯(lián)合操控水下機器人系統(tǒng)是強非線性系統(tǒng)，其各個自由度相互耦合，加之其欠驅(qū)動的特性，使得一般的控制算法難以很好地滿足控制系統(tǒng)要求。同時，由于安裝間隙的存在，使得在深度控制的過程中操作舵時會存在死區(qū)，通常死區(qū)的參數(shù)是未知的，這也增加了深度控制的復雜性。

本文針對舵機傳動系統(tǒng)中存在死區(qū)非線性的問題，同時考慮其欠驅(qū)動的運動特性及外界有界干擾和模型參數(shù)攝動，結(jié)合滑?？刂频乃枷?，設(shè)計了具有自適應(yīng)補償功能的PID深度控制器。該控制器顯著地降低了死區(qū)對系統(tǒng)的影響，提高了系統(tǒng)的響應(yīng)速度和控制精度，同時也增加了系統(tǒng)的魯棒性。

1 問題描述

1.1 垂直面運動模型

為便于問題描述，本文根據(jù)國際水池會議（ITTC）推薦的和造船與輪機工程學會（SNAME）術(shù)語公報的體系，同時參考有關(guān)資料，建立了AUV的垂直面的數(shù)學模型[4]

式中：ζ為AUV的深度；u0為AUV縱向速度；w為AUV垂向速度；θ為縱傾角（順時針為正）；q為縱傾角速度；m為AUV質(zhì)量；δ為實際舵角(左舵為正)；d1、d2為外界有界慢干擾。

1.2 舵機模型

由于舵機傳動系統(tǒng)存在間隙，使得某些時候舵機轉(zhuǎn)動，而舵板并沒有跟隨轉(zhuǎn)動?？紤]到舵機傳動系統(tǒng)死區(qū)形成原因，其死區(qū)模型表示為

式中：δr，δl為衡量舵角死區(qū)區(qū)間的值。一般有如下假設(shè)：

假設(shè)1：δr，δl的值為未知的，但是符號已知，即δr≥0≥δl；

假設(shè)2：δr，δl的值是有界的，即所以死區(qū)又可以表示如下：

式中：

1.3 模型簡化

欠驅(qū)動AUV在做小攻角下潛時可以認為sinθ≈θ，且其由柯氏力而產(chǎn)生的速度w可以認為很小，且遠小于縱向速度u0。由于AUV欠驅(qū)動的特性，可以認為，在做定深控制時，其縱向速度始終為一個正的數(shù)，即u0＞0。結(jié)合（1）、（4）和（5）式可以得到欠驅(qū)動AUV的垂直面運動模型：

假設(shè)3：外界干擾對系統(tǒng)的影響是有限的；

假設(shè)4：模型參數(shù)的攝動是在一定的范圍內(nèi)的。

由上可知，某微小型水下機器人的深度控制問題就是針對其運動系統(tǒng)（6），克服舵機系統(tǒng)的死區(qū)、外界干擾、模型參數(shù)攝動及建模誤差等不確定影響，設(shè)計一種深度控制器，其輸出的控制律δ，使深度全局漸進穩(wěn)定的收斂達到目標值。

2 控制器設(shè)計

針對微小型水下機器人存在的舵角死區(qū)、外界干擾及模型參數(shù)變化等問題，參考滑?？刂评碚?，可以將其深度控制器分成兩個部分，分別設(shè)計控制策略。一部分通過PID控制器進行控制；另一部分通過補償控制器進行控制。將相應(yīng)的控制率分成兩個部分，即u=u1+u2。其中u1為PID控制器的輸出，u2為補償控制器輸出。

2.1 PID控制器設(shè)計

則水下機器人的運動系統(tǒng)可改寫為

PID控制器就是對誤差信號e進行比例、積分和微分運算，其結(jié)果進行加權(quán)，得到控制器的輸出u1。

PID控制器的數(shù)學描述為：

式中：Kp，Ki，Kd為比例放大系數(shù)、積分時間常數(shù)和微分時間常數(shù)。令則（9）式可以寫成

控制率u1就是微小型水下機器人的PID深度控制器的控制率，其相關(guān)控制參數(shù)可以在理想模型下多次仿真實驗調(diào)節(jié)得到。根據(jù)（8）式可以建立如下的控制系統(tǒng)，

將（10）式代入（11）式可得

2.2 補償控制器設(shè)計

考慮到微小型水下機器人存在的舵角死區(qū)、外界干擾及模型參數(shù)變化等問題，參考滑模變結(jié)構(gòu)控制器原理，設(shè)計了補償控制器u2，該控制器用于補償參數(shù)變化帶來的影響。

式中：s=z1+c1z2+c2z3。

同時由于水動力參數(shù)發(fā)生變化，在寬廣水域獲得的控制器參數(shù)已經(jīng)不能成為其最優(yōu)的控制參數(shù)。假設(shè)W*為PID控制器的最優(yōu)控制參數(shù)為PID控制器的最優(yōu)控制輸出為補償控制器的最優(yōu)控制輸出，則最優(yōu)總輸出為

用估計值代替真實值，可以得到控制器的實際輸出

則輸出誤差為

定義李亞普諾夫函數(shù)為：

對上式微分可以得到

則（17）式可以化為

定義

將（19）、（20）、（21）式代入（18）式有

由此可知，該李亞普諾夫函數(shù)滿足穩(wěn)定性的條件，所設(shè)計的控制器是穩(wěn)定的。因此該自適應(yīng)PID控制系統(tǒng)可以表示為

其中PID參數(shù)變化率為（19）式所示，補償控制器的參數(shù)變化率為（21）式所示。

3 仿真結(jié)果和分析

進行了近水面深度控制仿真實驗，分別考慮了參數(shù)變化與未考慮參數(shù)變化兩種情況。AUV的初始狀態(tài)為靜止狀態(tài)，目標縱向速度為1 m/s，目標深度為1 m。AUV的直徑為0.34 m。未考慮參數(shù)變化時，PID控制器的控制參數(shù)為Kp=2.6，Kd=1.4，Ki=0.0025?？紤]受到近水面影響時，相關(guān)參數(shù)發(fā)生了變化，采用了參數(shù)自調(diào)節(jié)控制器，其控制參數(shù)的初始值與PID控制器一致。參數(shù)調(diào)節(jié)率相關(guān)實驗結(jié)果如圖1-4所示。

圖1 深度響應(yīng)曲線Fig.1 The depth response curve

圖2 縱傾變化曲線Fig.2 Trim change curve

圖3 舵角變化曲線Fig.3 Rudder angle curve

圖4 控制參數(shù)變化情況Fig.4 The change of control parameters

由圖1可知，采用自適應(yīng)PID（A-PID）控制器時穩(wěn)態(tài)誤差為0.003 m，要遠遠小于采用PID控制器時的0.02 m，且收斂時間也少。由圖2所示，其采用A-PID控制器時，穩(wěn)定航行時的縱傾角為0.132度，是為了部分抵消航行時外部干擾產(chǎn)生的影響。由圖3所示舵角的變化曲線差異較大，采用A-PID控制器時其最大舵角為6.47度，而PID控制器時其最大舵角為5.88度，但是最終穩(wěn)態(tài)舵角幾乎一致，這是因為考慮到舵機系統(tǒng)存在運動死區(qū)，為了獲得更好的控制效果，A-PID控制器對其進行了補償，根據(jù)補償?shù)幕驹砜芍?，在深度變化偏差較大時，補償量較大，在深度偏差較小時，補償量較小。同時，在整個控制過程中，考慮到各個外部的干擾和內(nèi)部的不確定性，A-PID控制器的控制參數(shù)變化如圖4所示，其中Kp從初始狀態(tài)的2.6先增大到3.718后減小至穩(wěn)定狀態(tài)3.664；Kd一直處于減小狀態(tài)，從初始狀態(tài)的1.4減小至1.374穩(wěn)定；Ki幾乎沒有變化。

由上分析可知，采用帶有補償功能的自適應(yīng)PID（A-PID）控制器能夠有效地抑制舵角死區(qū)、外界干擾及模型參數(shù)變化等問題對控制效果的影響，獲得了較好的控制效果。

4 結(jié) 論

水下機器人的深度控制精度是其重要的技術(shù)指標之一，關(guān)系到其是否能夠安全有效地完成作業(yè)任務(wù)。針對舵機傳動系統(tǒng)中存在死區(qū)非線性的問題，同時考慮其欠驅(qū)動的運動特性及外界有界干擾和模型參數(shù)攝動，結(jié)合滑?？刂频乃枷?，設(shè)計了具有自適應(yīng)補償功能的PID深度控制器。通過仿真實驗證明該控制器顯著地提高了系統(tǒng)的響應(yīng)速度和控制精度，同時也保證了系統(tǒng)的魯棒性。

[1]蔣新松,封錫盛,王棣棠.水下機器人[M].沈陽:遼寧科學技術(shù)出版社,2000:30-31.

[2]徐玉如,龐永杰,甘 永等.智能水下機器人技術(shù)展望[J].智能系統(tǒng)學報,2006,1(1):9-16. Xu Yuru,Pang Yongjie,Gan Yong,et al.AUV—state of the art and prospect[J].CAAI Transactions on Intelligent Systems,2006,1(1):9-16.

[3]封錫盛,李一平,徐紅麗.下一代海洋機器人—寫在人類創(chuàng)造下潛深度世界記錄10912米50周年之際[J].機器人, 2011,33(1):113-118. Feng Xisheng,Li Yiping,Xu Hongli.The next generation of unmanned marine vehicles dedicated to the 50 anniversary of the human world record diving 10 912 m[J].Robot,2011,33(1):113-118.

[4]朱心科,金翔龍,陶春輝等.海洋探測技術(shù)與裝備發(fā)展探討[J].機器人,2013,35(3):376-384. Zhu Xinke,Jin Xianglong,Tao Chunhui,et al.Discussion on development of ocean exploration technologies and equipments[J].Robot,2013,35(3):376-384.

[5]王 波.微小型水下機器人運動仿真研究[D].黑龍江:哈爾濱工程大學,2008. Wang Bo.Research on motion simulation of a small underwater vehicle[D].Harbin:Harbin Engineering University,2008.

[6]Kim Y S,Lee J,Park S K,et al.Path tracking control for underactuated AUVs based on resolved motion acceleration control[C]//Proc.the Fourth International Conference on Autonomous Robots and Agents.Wellington,2009:511-515.

[7]Tehrani N H,Heidari M,Zakeri Y,et al.Development,depth control and stability analysis of an underwater remotely operated vehicle(ROV)[C]//The 8th IEEE IntConf on Control and Automation.Xiamen:IEEE,2010:814-819.

[8]Soylu S,Buckham B J,Podhorodeski R P.A chattering-free sliding-mode controller for underwater vehicles with faulttolerant infinity-norm thrust allocation[J].Ocean Engineering,2008,35(16):1647-1659.

[9]朱康武,顧臨怡,馬新軍等.水下運載器多變量魯棒輸出反饋控制方法[J].浙江大學學報:工學版,2012,46(8): 1397-1406. Zhu Kangwu,Gu Linyi,Ma Xinjun,et al.Studies on multivariable robust output feedback control for underwater vehicle [J].Journal of Zhejiang University(Engineering Science),2012,46(8):1397-1406.

[10]Sharma R,Rana K P S,Kumar V.Performance analysis of fractional order fuzzy PID controllers applied to a robotic manipulator[J].Expert Systems with Applications,2014,41(9):4274-4289.

[11]Duan Xiaogang,Li Hanxiong,Deng Hua.Robustness of fuzzy PID controller due to its inherent saturation[J].J of Process Control,2012,22(2):470-476.

[12]Hu Bo,Tian Hai,Qian Jiani.A fuzzy-PID method to improve the depth control of AUV[C].IEEE International Conference on Mechatronics and Automation,2013:1528-1533.

[13]Batista,Silvestre C,Oliveira P.A sensor-based controller for homing of underactuated AUVs[J].IEEE Transactions on Robotics,2009,25(3):701-716.

[14]Li J H,Lee P M.Asymptotic diving control method for torpedo-type underactuated AUVs[C]//Ocean 2008.Quebec, Canada,2008:1-5.

[15]Liang Xiao,Guo Bingjie,Wan Lei.Motion control of mini underwater robots based on sigmoid fuzzy neural network[C]// IEEE International Conference of Automation and Logistics,Augest 2007.Shangdong,China,2007:918-922.

Study on the depth control of underactuated AUV with dead-zone compensation

JI Xing,SU Yu-min,ZHANG Guo-cheng
(State Key Laboratory of Autonomous Underwater Vehicle,Harbin Engineering University,Harbin 150001,China)

In the underactuated AUV Controlled by thrusters and fins,the dead-zone nonlinearity of steering engine transmission system can direct influence the depth control performance.In this paper,under-actuated motion characteristic external bounded disturbance and model parameter perturbation are considered.A PID with self-adaptive compensation function is proposed.With the help of Lyapunov function,the control system is proved to be globally stable.The simulation results show effectiveness of this method.

underactuated AUV;depth control;adaptive control;Dead-Zone Compensation

U674.941

A

10.3969/j.issn.1007-7294.2016.07.008

1007-7294（2016）11-1420-07

2016-07-28

國家自然科學基金（51579053）

紀 興（1984-），男，博士研究生，E-mail：869400673@qq.com；蘇玉民（1960-），男，教授，博士生導師。