水下滑翔機動力學建模及PID控制

王旭超，齊向東

(太原科技大學 電子信息與工程學院，山西 太原 030051)

水下滑翔機動力學建模及PID控制

王旭超，齊向東

(太原科技大學 電子信息與工程學院，山西 太原 030051)

為了解決水下滑翔機的控制問題，設計了尾部四螺旋槳來控制滑翔機的俯仰和轉向，對水下滑翔機進行運動學和動力學建模，并在其基礎上設計了PID控制器。通過Matlab/Simulink仿真和湖試對所設計的PID控制器的有效性進行驗證。仿真結果表明在所設計的PID參數下，控制器能夠有效地完成水下滑翔機自穩定控制。湖試結果與仿真結果相比較，可以得出設計的PID控制器參數選取合理，能夠快速準確地實現姿態的調節。

水下滑翔機；動力學模型；PID控制；Matlab仿真；湖試

0 引 言

21世紀以來，海洋資源的開發和利用問題越來越引起人們的關注，隨著技術的不斷成熟，水下滑翔機作為一種新型的海洋勘測工具逐漸發展起來。水下滑翔機中的姿態調節單元能調整機體的俯仰角和偏轉角，是AUV的重要運動功能單元，其設計的優劣直接影響AUV運動性能的好壞。傳統的方式通過調整內部壓載重塊的位置，在浮力調節單元外皮囊體積變化和水平機翼的配合下，實現航行器轉向運動。由于這種方法是間接通過改變重心來改變姿態的，這就導致控制過程中的不精確和不穩定性，尤其在受到外界干擾時，這種不穩定性會被放大，從而導致任務失敗。針對水下滑翔機動力學的非線性、強耦合、模型參數復雜，因此設計了多槳驅動無舵水下滑翔機[1]。通過4個螺旋槳的互相協調配合，直接改變轉速來改變運動姿態，在建立了運動模型基礎上，結合PID算法，設計合理的PID控制器，用仿真來驗證算法的穩定性和抗干擾能力，并通過試驗來驗證這種方法的有效性。

1 結構及其工作原理

按照水下滑翔機所實現的功能來分，其結構主要可以分為：頭部裝置、控制段、載荷段、動力段、整流罩。具體結構如圖 1所示。

工作原理：水下滑翔機依靠電機驅動液壓泵，調節內壓水倉的體積，從而改變整個系統的總浮力, 使其上浮或者下潛，其姿態通過尾部的螺旋槳產生的推力來實現。它以中等航程、高穩定度姿態航行、定時間任務為目標。結構形式為，其裝配小型化平衡用壓水艙，其余空間大量列裝高能電池，以自身攜帶的高能電池為動力，依托壓水艙的作用，完成浮力變化，當浮力與重量相當時，即可進入運動模式，工作流程如圖 2所示。

2 滑翔機動力學模型的建立

水下滑翔機是一個非線性、多變量、高度耦合的系統，所以在實現其功能的精確控制之前，首先必須對其進行力學和動力學上的分析，并且建立合適的動力學模型，最后根據其控制對象設計合理的控制器。

2.1 坐標系的選擇和建立

想要建立水下滑翔機模型，第1步的任務就是建立適當的坐標系，對于本設計，我們可以通過建立2個坐標系來解決，這2個坐標系分別為地面和載體坐標系體，都符合右手定則[2]。

2.1.1 地面坐標系

地面坐標系（以下稱為SE）的坐標原點選在滑翔機的入水處，EX為水平方向，EY軸垂直水面向下，EZ軸與EX EY軸垂直，其方向由右手定則確定。

2.1.2 載體坐標系

為了方便分析，我們選取載體坐標系的原點在其浮心，Bx與滑翔機機身平行，方向水平向前，By與機身垂直，Bz軸分別于BxBy軸垂直。

2個坐標系之間的向量變化需要通過旋轉矩陣來變換，其變換矩陣為：

2.2 四螺旋槳原理分析

螺旋槳在高轉速運行時會出現反扭矩，并且其方向與本身旋轉的方向相反，然而這種反方向的扭矩對整個系統的穩定性有很嚴重的影響。為了消除這種反扭矩，我們通常會采用尾槳或者與其共軸的反轉螺旋槳來解決問題，但是對于本設計，由于其結構的原因，不需要再做一些附加的工具或者方法，完全可以通過合理4個螺旋槳的轉向來消除[3]。如圖 4所示，將4個螺旋槳按照旋轉45°的“十”字方式來排列，逆時針對其進行編號，分別為1，2，3，4，這時只需要保持1號和3號螺旋槳逆時針旋轉，而2號和4號螺旋槳順時針旋轉，2號和4號螺旋槳產生的反扭矩順其自然的就會與1號和3號螺旋槳產生反扭矩抵消掉。

四螺旋槳的姿態控制主要包括俯仰角控制、橫滾角控制、偏航角控制，通過調節各個螺旋槳的轉速即可調節AUV的姿態。

2.3 運動方程建立

對于AUV來講，它的運動形式和飛機一樣，具有六自由度，在空間中的包括3個平移和3個旋轉運動。

2.3.1 平移運動方程

2.3.2 旋轉運動方程

2.4 滑翔機受力分析

如圖 5所示，滑翔機在水下工作的過程中，由于重心和浮心不重合，將會產生一個扶正力矩，對滑翔機進行受力分析，包括浮力B，重力G，螺旋槳推力Ft，水動力 FV，FI。

2.4.1 重力浮力

在滑翔機剛放入水中時，由于它本身的重力等于浮力，并且方向相反，大小相等，所以垂直方向的合力為0。在建立載體坐標系的時候，選取浮心為原點，然而由于浮心與重心的位置并不重合，所以浮心和重心的位置矢量為，因此在工作過程中，重力，浮力和扶正力矩在載體坐標系下的表示為：

2.4.2 螺旋槳推力與力矩

根據螺旋槳環流理論的觀點，在不可壓縮的理想流體中，螺旋槳轉動所產生的推力Ft和扭矩Tt可以用式（8）表示。

對于式（8），其中包含著對環量和誘導速度的計算，但是由于在實際工程中沒有必要設計這么詳細的計算，所以將其簡化，故螺旋槳推力Ft和扭矩Tt在載體坐標系下可表示為式（9）。

式中：KT為推力系數；t為推力減額系數；n為螺旋槳轉速，r/s；dP為螺旋槳外徑，m；KQ為力矩系數。Kt和KQ可根據螺旋槳模型敞水試驗獲得。

另外由于滑翔器配有4個螺旋槳，其按環形布置，如圖 4所示。設4個推力器關于o點對稱布置，這種布置方案的機動性能好。所以其空間總推力和總力矩的計算式為：

2.4.3 流體動態力

分為粘性水動力和慣性水動力，在此不具體分析，見參考文獻[4]。

根據前面的分析結果，將各個力和力矩結合起來，就可以得出滑翔器所受到的總外力和力矩，如下所示：

2.5 滑翔機動力學方程

為使被研究的問題簡化，由于滑翔機本身在工作中自身的變化不影響整個的運動過程，因此可以將滑翔機視作剛體，各個變量如表1所示。

根據地面坐標系與本體坐標系之間的坐標轉換關系，以及剛體的動量定理，最終得到了滑翔器的動量和角動量在本體坐標系下的表達形式：

表1 變量定義Tab. 1 Variable definitions

其中fi為滑翔機受到的外力在地面坐標系下的表達，di為fi的作用點到浮心得距離。

除此之外，根據剛體轉動定律可以推出滑翔機對質心動量矩的另一種表示：

在一般情況下，由于水下環境復雜，可能存在著暗流、暗礁等，為了提高滑翔機穩定性，在對滑翔機的機械結構設計時，通常會故意將滑翔機的重心在鉛垂方向上略低于浮心。根據運動學知識以及剛體轉動定理最終得到了滑翔機的動力學模型。

之后將滑翔機的運動方程即平移和旋轉方程代入進一步可得滑翔機的空間運動方程和動力學方程在本體坐標系下的一般表達形式：

將滑翔機的各項參數代入式（15）和式（16）之后，經過計算可以得到穩態滑翔機穩態參數，以及該平衡點附近的小擾動線性系統。

3 PID控制器設計

選取系統的狀態向量和控制輸入向量為

對滑翔機在平衡態處線性化，得到小擾動線性化模型：

實際過程控制中，PID控制器的數學模型為：

其中：Kp，，分別為比例，積分，微分加權系數。針對4個螺旋槳的轉速設計PID控制器。

式中，r為螺旋槳編號。

4 Matlab/Simulink仿真

根據PID系統的結構圖，搭建Matlab simulink模型并仿真。

4.1 下潛與上浮過程仿真

假設初始情況下，滑翔機浮力等于重力，并且以設定的速度勻速在水面直行，下潛程序啟動，此時2，3電機為主轉電機，1，4號電機為輔助電機，使滑翔機以–45°的滑翔角下潛，下潛至定深10 m時，開始上浮，電機的功能與下潛時相反，以+45°的仰角到達水面。滑翔軌跡如圖所示。選取，，。上浮時1，4螺旋槳的系數與下潛時的2，3系數相同。

由圖 8可以看出，在43 s時執行下潛程序，滑翔機以–45°開始下潛，下潛過程中，角度以及主轉電機響應速度快，并且在到達設定值時，系統穩定性好。

4.2 偏轉過程仿真

滑翔機初始情況與4.1相同，當到達設定的偏轉位置時，1，2號電機作為主轉電機，3，4號為輔助電機，使滑翔機以給定偏航角進行轉彎，此時希望轉彎半徑盡可能達到最小選取，Ki4= 6，。

由于在偏轉過程中，主轉電機與下潛過程中主轉電機相似，在這里不重復表達。

仿真結果表明：PID參數的合理選取，使得系統超調量較小，穩態誤差幾乎為零，響應速度快，系統仿真驗證了PID控制的有效性。

5 湖 試

為了驗證系統的可行性，首先選擇在千島湖進行湖試，主要目的是對系統的下潛和偏轉的穩定性進行試驗。試驗的過程主要圍繞選定的3個位于三角形頂點的GPS點進行，如圖 12所示，試驗路線由起點1到2 到3 再返回到1，1號點到2號點之間進行的為水面的直線運動，2號點到3號點進行完成了下潛，并做定深運動，3號到1號點進行上浮。整個過程的實際航線、偏轉角度、速度以及下潛深度等由記錄儀進行記錄，在試驗結束之后下載到電腦進行分析。

如圖 13所示，其中0～60 s，對應1號點到2號點的運動過程，為滑翔機下潛過程，由圖可以看出，從響應開始到穩定整個俯仰角度的調節過程只需要3 s左右，超調量在5%左右。同樣60～120 s和120～180 s分別對應2號點到3號點再到1號點的定深運動和上浮過程。從而可以得出調節時間較短，超調量較小，與仿真結果相符。

6 結 語

本設計摒棄了大部分滑翔機帶舵的設計思路，整體類似于一個圓柱體，本身阻力很小，主要通過調節4個對稱螺旋槳的轉速來實現調姿。本文建立了滑翔機的動力學模型并且得到了其小擾動模型，在此基礎上設計了合理的控制器，之后在M atlab/simulink上進行仿真，并將其結果與湖試結果對比，驗證了PID控制器的可靠性。

[ 1 ]WANG S X, SUN X J, WU J G, et al. Motion characteristic analysis of a hybrid-driven underwater glider[C]// OCEANS 2010 IEEE-Sydney. IEEE, 2010: 1–9.

[ 2 ]王樹新, 劉方, 邵帥, 等. 混合驅動水下滑翔機動力學建模與海試研究[J]. 機械工程學報, 2014, 50(2): 16–17.WANG Shu-xin, LIU Fang, SHAO Shuai, et al. Dynam ic modeling of hybrid underwater glider based on the theory of differential geometry and sea trails[J]. Journal of Mechanical Engineering, 2014,50(2): 16–17.

[ 3 ]楊慶華, 宋召青. 四旋翼飛行器建模、控制與仿真[J]. 海軍工程學院學報, 2009, 24(5): 485–502.

[ 4 ]王曉鳴. 混合驅動水下自航行器動力學行為與控制策略研究[D]. 天津: 天津大學. 2009: 20–25.

[ 5 ]ROBERTS G N, SUTTON R. Further advances in unmanned marine vehicles[M]. Piscataway: IET, 2006: 33–35.

[ 6 ]JOSHUA G G. Underwater gliders: dynam ics, control and design[D]. New Jersey: Princeton University, 2005: 15–17.

[ 7 ]SALIH A L. MODELLING and PID controller design for a quadrotor unmanned air vehicle[J]. IEEE AQTR. 2010, 39(5):697–699.

[ 8 ]陳宇航. 水下滑翔機建模與控制研究[R]. 西安: 西北工業大學, 2009.

[ 9 ]蔣新松, 封錫盛, 王棣棠. 水下機器人[M].沈陽: 遼寧科學技術出版社, 2000: 304–311.

[10]郭威, 崔勝國, 趙洋, 等. 一種遙控潛水器控制系統的研究與應用[J]. 機器人, 2008, 30(5): 5–6.Guo Wei, CUI Sheng-guo, ZHAO Yang, et al. Research and application o f a control system for remotely operated vehicle[J]. Robot, 2008, 30(5): 5–6.

Dynam ic modeling and PID control of underwater glider

WANG Xu-chao, QI Xiang-dong
(School of Electronics and Information, Taiyuan University of Science and Technology, Taiyuan 030051, China)

In order to solve the problem of underwater glider control, the tail four-propeller is designed to control the pitching and steering of the glider. The kinematics and dynamics of the underwater glider are modeled and the PID controller is designed on the basis of it. The validity of the designed PID controller is verified by Matlab/simulink simulation and lake test. The simulation results show that the controller can effectively control the self-stabilization of the underwater glider under the designed PID parameters. Compared with the simulation results, it can be concluded that the design of the PID controller is reasonable and the attitude can be adjusted quickly and accurately.

underwater glider；dynamic model；PID control；Matlab simulation；lake test

N945.12；TP391.9

A

1672–7649(2017)12–0064–06

10.3404/j.issn.1672–7649.2017.12.014

2017–09–07；

2017–09–18

王旭超(1993–)，男，碩士研究生，研究方向為水下滑翔機姿態調節。