馮曉波 韓佳穎 董博通

摘要：為了改善實船控制裝置的復(fù)雜性和非標準化的情況，設(shè)計將通用控制器來替代現(xiàn)有機-槳-舵控制系統(tǒng)的控制單元，構(gòu)建基于串級PID的船舶運動控制系統(tǒng)，通過matlab編寫仿真程序?qū)刂苹芈愤M行檢驗證明串級PID控制的合理性。

Abstract： In order to improve the complexity and non-standardization of the actual ship control device， the general controller is designed to replace the control unit of the existing machine-propeller-rudder control system， and the ship motion control system based on cascade PID is constructed， which is written by matlab The simulation program checks the control loop to prove the rationality of the cascade PID control.

關(guān)鍵詞：船舶;運動控制;PID

Key words： ship;motion control;PID

中圖分類號：TP183? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ?文獻標識碼：A? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? 文章編號：1674-957X（2020）21-0205-02

0? 引言

當前較多的船舶設(shè)備已經(jīng)采用通用控制器PLC或者單片機作為控制裝置[1]。但船舶的機、槳、舵系統(tǒng)較多仍采用非通用的控制裝置[2]，控制裝置結(jié)構(gòu)復(fù)雜，且船舶整體運動控制調(diào)節(jié)難度較大。隨著自動化進程的加快，很多學(xué)者已經(jīng)開始研究將通用控制組件如PLC、單片機應(yīng)用于槳和舵的控制中[3]，這促進了船舶運動控制系統(tǒng)的變革。本文借鑒當前無人機的運動控制理念[4]，采用通用控制裝置來構(gòu)建船舶的航向和速度的串級PID控制模塊，而執(zhí)行單元采用舵機和調(diào)速器或調(diào)速電機來執(zhí)行，使控制裝置簡單化，也有助于控制裝置的聯(lián)網(wǎng)通信，實現(xiàn)機-槳-舵的整體控制。

1? 船舶的控制系統(tǒng)

1.1 船舶的姿態(tài)描述

將船體看成一個質(zhì)點，如圖1所示，船體坐標系O1（X1，Y1，Z1）隨船體運動，原點O1固聯(lián)于船舶質(zhì)心。X軸沿船身構(gòu)造基線方向指向船頭，Y軸指向左舷，Z軸由右手定則確定指向上方。定義船舶啟航時的船體坐標系與地面坐標系O（X，Y，Z）一致。船舶的姿態(tài)由三個角度（歐拉角）表示：縱傾角？琢，航向角？茁，橫傾角？酌。船舶的位置由X1，Y1，Z1三個位置參數(shù)表示。影響航行軌跡的參數(shù)主要包括航向角和對地航速。

1.2 船舶的運動控制流程

船舶控制器的控制流程如圖1所示。船舶位姿六坐標參數(shù)由傳感器GPS、羅經(jīng)和加速度計測量。根據(jù)當前船舶所處的經(jīng)緯度和目標航點可以確定目標航向，從而獲得船舶當前航向角與目標航向角的偏差？駐？茁。位姿控制器通過調(diào)節(jié)舵角來減小偏航角？駐？茁使船舶航向角與目標航向一致。速度控制器根據(jù)對地航速和航速設(shè)定值的偏差調(diào)整調(diào)速器或者調(diào)速電機增減油門，改變螺旋槳的轉(zhuǎn)速，滿足船舶對地航速的需求。這兩方面的共同作用確保船舶沿著設(shè)計航線在指定時間到達目的港。航行過程中的橫傾、縱傾或者隨波起伏帶來船舶姿態(tài)的改變或者出現(xiàn)變形，影響船舶的安全，也成為現(xiàn)代船舶安全控制的關(guān)注點[5]。

2? 串級PID航向航速控制方法

2.1 PID控制原理

把比例、積分、微分作用結(jié)合在一起，構(gòu)成比例積分微分作用規(guī)律即PID作用規(guī)律。PID作用規(guī)律輸入與輸出的關(guān)系為：

（1）

式中K為比例系數(shù)，Ti為積分時間，Td為微分時間，e為偏差值。其中比例系數(shù)K越大，比例作用越強;積分時間Ti越小，積分作用越強;微分時間Td越小，微分作用越強。為了實現(xiàn)計算機的處理，將連續(xù)函數(shù)離散化成周期采樣偏差函數(shù)式，離散形式為：

（2）

2.2 串級PID控制

船舶是一個非線性的系統(tǒng)，如果船舶采用單級 PID 算法進行控制， 會使系統(tǒng)存在不同程度的超調(diào)和震蕩。故本設(shè)計在姿態(tài)控制中又加入角速度環(huán)，構(gòu)成了串級 PID 控制器。以航向角控制為例，如圖2所示。姿態(tài)串級PID控制分內(nèi)環(huán)和外環(huán)，內(nèi)環(huán)的輸入是角速度，角速度設(shè)定值與羅經(jīng)和加速度儀的測量值之間的偏差觸發(fā)角速度PID控制舵機，使得角速度達到設(shè)定值。外環(huán)的輸入是姿態(tài)歐拉角，設(shè)定值與四元數(shù)解算后的歐拉角之間的偏差觸發(fā)角度PID設(shè)定新的角速度輸入內(nèi)環(huán)。船舶采用串級 PID 控制器進行控制，即使外環(huán)數(shù)據(jù)劇烈變化，仍然可以有一個良好的控制效果。速度串級PID控制與姿態(tài)控制類似。

2.3 控制系統(tǒng)的實現(xiàn)

采用matlab的simulink模塊對上述船舶的運動控制進行仿真如圖2所示，該仿真程序與圖3的PID控制模塊一一對應(yīng)，本文實驗設(shè)定目標軌跡為橢圓，模塊1，2，3，4描述參數(shù)V，？琢，？茁，？酌的實時目標值，模塊5，6，7，8設(shè)定參數(shù)？琢，？茁，？酌，V的當前測量值。第一級PID控制器的輸出的目標角速度和加速度作為第二級PID控制器的輸入。四元數(shù)轉(zhuǎn)換為歐拉角模塊輸入角速度和加速度的當前計算值，用于計算第二級PID控制器的偏差。第二級PID控制器輸出與控制分配模塊相連?？刂品峙淠K接收控制信號，將其分配給執(zhí)行單元。航向角控制的執(zhí)行單元是舵機，橫傾和縱傾角的是電機，速度控制的是調(diào)速器?？刂品峙淠K與舵機、電機和調(diào)速器間采用pwm信號通信。PID控制的常用設(shè)備包括單片機、PLC等具有pwm輸出信號的控制器，輸出信號與調(diào)速器或調(diào)速電機和舵機能夠直接通信，這樣就實現(xiàn)船舶舵角、縱橫傾角和螺旋槳轉(zhuǎn)速的控制。

仿真結(jié)果如圖3所示，通過串級PID的控制作用能夠使得船舶的軌跡最終回到設(shè)定的橢圓軌跡，證明串級PID程序控制系統(tǒng)的合理性。

3? 總結(jié)與展望

本文借鑒當前無人機的運動控制方法，將其應(yīng)用與船舶領(lǐng)域。設(shè)計船舶運動控制系統(tǒng)的基本框架，構(gòu)建串級PID程序控制船舶的姿態(tài)和航速并應(yīng)用仿真平臺對控制流程進行驗證。該設(shè)計采用通用控制器對船舶的舵和槳進行控制，能夠簡化控制設(shè)備，但其實現(xiàn)依賴通用控制器如PLC技術(shù)可靠性實時性等性能的改善。

參考文獻：

[1]李勃良.基于PLC技術(shù)和工業(yè)現(xiàn)場總線技術(shù)的船舶電力監(jiān)控系統(tǒng)設(shè)計[J].艦船科學(xué)技術(shù)，2020，42（16）：118-120.

[2]林文城.船用舵機控制系統(tǒng)的設(shè)計研究[J].船電技術(shù)，2020，40（09）：1-3.

[3]陳哲超.基于PLC的自動平衡控制系統(tǒng)及方法研究[D].北京化工大學(xué)，2018.

[4]景曉年，梁曉龍，張佳強，朱創(chuàng)創(chuàng).基于交互多模型的無人機運動控制[J].火力與指揮控制，2017，42（12）：17-21，26.

[5]徐學(xué)東.高海情下的船舶橫搖運動控制研究[J].艦船科學(xué)技術(shù)，2020，42（14）：40-42.