CN112947443B - Ship control method, system and storage medium based on Henry gas solubility - Google Patents
Ship control method, system and storage medium based on Henry gas solubility Download PDFInfo
- Publication number
- CN112947443B CN112947443B CN202110170522.6A CN202110170522A CN112947443B CN 112947443 B CN112947443 B CN 112947443B CN 202110170522 A CN202110170522 A CN 202110170522A CN 112947443 B CN112947443 B CN 112947443B
- Authority
- CN
- China
- Prior art keywords
- ship
- gas
- henry
- information
- state
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 66
- 239000007789 gas Substances 0.000 claims description 138
- 230000006870 function Effects 0.000 claims description 16
- 238000011156 evaluation Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 17
- 239000011159 matrix material Substances 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 3
- 230000006978 adaptation Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
Description
技术领域technical field
本发明涉及船舶控制技术领域,尤其是一种基于亨利气体溶解度的船舶控制方法、系统和存储介质。The invention relates to the technical field of ship control, in particular to a ship control method, system and storage medium based on Henry gas solubility.
背景技术Background technique
随着海上活动的增加,海上运输环境也越来越复杂,船舶运输的安全航行已成为航运领域研究的焦点。目前,船舶运动的控制方式主要通过预先训练好的模型进行控制,这类控制方式,通常无法预先判断船舶下一步的运动状态,同时,由于模型是预先训练好的,导致其依赖于模型预先设置的约束,大大限制了基于模型设置的船舶控制方法在其他类型船舶上的适应能力。With the increase of maritime activities, the marine transportation environment is becoming more and more complex, and the safe navigation of ship transportation has become the focus of research in the field of shipping. At present, the control method of ship motion is mainly controlled by a pre-trained model. This kind of control method usually cannot predict the next motion state of the ship in advance. At the same time, because the model is pre-trained, it depends on the pre-setting of the model. , which greatly limits the adaptability of model-based ship control methods on other types of ships.
发明内容SUMMARY OF THE INVENTION
本发明旨在至少解决现有技术中存在的技术问题之一。为此,本发明提出一种基于亨利气体溶解度的船舶控制方法、系统和存储介质,能够有效应用于多种类型船舶的运动过程。The present invention aims to solve at least one of the technical problems existing in the prior art. Therefore, the present invention proposes a ship control method, system and storage medium based on Henry gas solubility, which can be effectively applied to the motion process of various types of ships.
根据本发明的第一方面实施例的一种基于亨利气体溶解度的船舶控制方法,包括以下步骤:A method for controlling ships based on Henry's gas solubility according to the first aspect of the present invention, comprising the following steps:
获取船舶当前时刻的状态信息;Get the status information of the ship at the current moment;
构建船舶运动模型;Build a ship motion model;
根据当前时刻的状态信息结合所述船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息;According to the state information at the current moment in combination with the ship motion model, the Henry gas solubility prediction method is used to predict the ship control information of the ship at the next moment;
根据所述船舶控制信息控制船舶运动。The movement of the vessel is controlled according to the vessel control information.
根据本发明实施例的一种基于亨利气体溶解度的船舶控制方法,至少具有如下有益效果:A ship control method based on Henry gas solubility according to an embodiment of the present invention has at least the following beneficial effects:
本发明实施例通过先获取船舶当前时刻的状态信息和构建船舶运动模型,接着根据当前时刻的状态信息结合船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息,然后通过控制信息控制船舶运动,本实施通过采用亨利气体溶解度预测方式实时预测下一时刻的船舶控制信息,以提高预测过程的收敛速度,同时使得本实施例能够有效应用于多种类型的船舶运动控制过程。In the embodiment of the present invention, the state information of the ship at the current moment is obtained and the ship motion model is constructed, and then the ship control information of the ship at the next moment is predicted by the Henry gas solubility prediction method according to the state information at the current moment and the ship motion model. The information controls the ship motion. This implementation uses the Henry gas solubility prediction method to predict the ship control information at the next moment in real time, so as to improve the convergence speed of the prediction process, and at the same time, this embodiment can be effectively applied to various types of ship motion control processes.
根据本发明的一些实施例,所述获取船舶当前时刻的状态信息,包括:According to some embodiments of the present invention, the acquiring the state information of the ship at the current moment includes:
获取船舶当前时刻的硬件数据,所述硬件数据包括船舶舵角、船舶螺旋桨转速、GPS位置信息、船舶航向角、船舶艏向角;Obtain the hardware data of the ship at the current moment, the hardware data includes the ship's rudder angle, the ship's propeller rotation speed, the GPS position information, the ship's heading angle, and the ship's heading angle;
根据所述硬件数据分析船舶当前时刻的状态信息。The state information of the ship at the current moment is analyzed according to the hardware data.
根据本发明的一些实施例,所述构建船舶运动模型,其具体为:According to some embodiments of the present invention, the construction of the ship motion model is specifically:
根据船舶的运动特征信息构建三自由度船舶运动模型。A three-degree-of-freedom ship motion model is constructed according to the motion characteristic information of the ship.
根据本发明的一些实施例,所述亨利气体溶解度预测方式,包括以下步骤:According to some embodiments of the present invention, the Henry gas solubility prediction method includes the following steps:
初始化亨利气体参数,所述亨利气体参数包括亨利系数、分压和气体类型;initialize Henry gas parameters, the Henry gas parameters include Henry coefficient, partial pressure and gas type;
对若干个气体团簇进行评估和排序,确定符合预设要求的气体;Evaluate and rank several gas clusters to identify those that meet preset requirements;
根据所述符合预设要求的气体更新亨利气体参数;Update Henry gas parameters according to the gas meeting the preset requirements;
跳出气体团簇的局部最优;Jump out of the local optimum of gas clusters;
更新最差气体位置;Update the worst gas position;
确定符合预设要求的气体的位置信息。Determine location information for gases that meet preset requirements.
根据本发明的一些实施例,所述对若干个气体团簇进行评估和排序,确定符合预设要求的气体,包括:According to some embodiments of the present invention, the evaluation and sorting of several gas clusters to determine the gas that meets the preset requirements includes:
对若干个气体团簇进行评估,确定每个气体类型中最高平衡状态的最佳气体;Evaluation of several gas clusters to determine the best gas in the highest equilibrium state for each gas type;
对所述最佳气体进行排序,确定所述若干个气体团簇对应组群的最优气体。The optimal gas is sorted, and the optimal gas of the group corresponding to the plurality of gas clusters is determined.
根据本发明的一些实施例,所述符合预设要求的气体的位置信息为所述船舶控制信息。According to some embodiments of the present invention, the position information of the gas that meets the preset requirement is the ship control information.
根据本发明的一些实施例,在执行所述根据当前时刻的状态信息结合所述船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息这一步骤时,还包括以下步骤:According to some embodiments of the present invention, when performing the step of predicting the ship control information of the ship at the next moment by using the Henry gas solubility prediction method according to the state information at the current moment in combination with the ship motion model, the following steps are further included:
设置适应度函数,所述适应度函数公式如下所示:Set the fitness function, the fitness function formula is as follows:
其中,q为权重因子;Q为总的权重因子;Np为预测步数;fbest(j)为单次的适应度函数值;RREF=[Rref(j),Rref(j+1),…,Rref(j+Np)]T; SSTATE=[Sstate(j),Sstate(j+1),…,Sstate(j+Np)];Sstate(j)=[η v];Rref为参考轨迹。Among them, q is the weight factor; Q is the total weight factor; N p is the number of prediction steps; f best (j) is the single fitness function value; R REF =[R ref (j),R ref (j+1),…,R ref (j+N p )] T ; S STATE =[S state (j),S state (j+1),… , S state (j+N p )]; S state (j)=[η v]; R ref is the reference trajectory.
根据本发明的第二方面实施例的一种基于亨利气体溶解度的船舶控制系统,包括:A ship control system based on Henry's gas solubility according to the second aspect of the present invention, comprising:
获取模块,用于获取船舶当前时刻的状态信息;The acquisition module is used to acquire the status information of the ship at the current moment;
构建模块,用于构建船舶运动模型;Building blocks for building ship motion models;
预测模块,用于根据当前时刻的状态信息结合所述船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息;The prediction module is used for predicting the ship control information of the ship at the next moment by using the Henry gas solubility prediction method according to the state information at the current moment in combination with the ship motion model;
控制模块,用于根据所述船舶控制信息控制船舶运动。The control module is used for controlling the movement of the ship according to the ship control information.
根据本发明的第三方面实施例的一种基于亨利气体溶解度的船舶控制系统,包括:A ship control system based on Henry's gas solubility according to a third aspect of the present invention, comprising:
至少一个存储器,用于存储程序;at least one memory for storing programs;
至少一个处理器,用于加载所述程序以执行第一方面实施例所述的基于亨利气体溶解度的船舶控制方法。At least one processor, configured to load the program to execute the method for controlling a ship based on Henry gas solubility according to the embodiment of the first aspect.
根据本发明的第四方面实施例的一种存储介质,其中存储有处理器可执行的程序,所述处理器可执行的程序在由处理器执行时用于执行第一方面实施例所述的基于亨利气体溶解度的船舶控制方法。A storage medium according to an embodiment of a fourth aspect of the present invention stores therein a program executable by a processor, and when executed by the processor, the program executable by the processor is used to execute the embodiment of the first aspect A ship control method based on Henry's gas solubility.
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。Additional aspects and advantages of the present invention will be set forth, in part, from the following description, and in part will be apparent from the following description, or may be learned by practice of the invention.
附图说明Description of drawings
下面结合附图和实施例对本发明做进一步的说明,其中:The present invention will be further described below in conjunction with the accompanying drawings and embodiments, wherein:
图1为本发明实施例的一种基于亨利气体溶解度的船舶控制方法的流程图;Fig. 1 is a flow chart of a ship control method based on Henry's gas solubility according to an embodiment of the present invention;
图2为一种实施例的船舶控制系统结构示意图;2 is a schematic structural diagram of a ship control system according to an embodiment;
图3为一种实施例的亨利气体溶解度预测结构示意图;Fig. 3 is the Henry gas solubility prediction structural schematic diagram of a kind of embodiment;
图4为一种实施例的船舶运动控制流程图。FIG. 4 is a flow chart of ship motion control according to an embodiment.
具体实施方式Detailed ways
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。The following describes in detail the embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein the same or similar reference numerals refer to the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the accompanying drawings are exemplary, only used to explain the present invention, and should not be construed as a limitation of the present invention.
在本发明的描述中,需要理解的是,涉及到方位描述,例如上、下、前、后、左、右等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。In the description of the present invention, it should be understood that the azimuth description, such as the azimuth or position relationship indicated by up, down, front, rear, left, right, etc., is based on the azimuth or position relationship shown in the drawings, only In order to facilitate the description of the present invention and simplify the description, it is not indicated or implied that the indicated device or element must have a particular orientation, be constructed and operated in a particular orientation, and therefore should not be construed as limiting the present invention.
在本发明的描述中,若干的含义是一个以上,多个的含义是两个以上,大于、小于、超过等理解为不包括本数,以上、以下、以内等理解为包括本数。如果有描述到第一、第二只是用于区分技术特征为目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。In the description of the present invention, the meaning of several means one or more, the meaning of multiple means two or more, greater than, less than, exceeding, etc. are understood as not including this number, above, below, within, etc. are understood as including this number. If it is described that the first and the second are only for the purpose of distinguishing technical features, it cannot be understood as indicating or implying relative importance, or indicating the number of the indicated technical features or the order of the indicated technical features. relation.
本发明的描述中,除非另有明确的限定,设置等词语应做广义理解,所属技术领域技术人员可以结合技术方案的具体内容合理确定上述词语在本发明中的具体含义。In the description of the present invention, unless otherwise clearly defined, words such as setting should be understood in a broad sense, and those skilled in the art can reasonably determine the specific meanings of the above words in the present invention in combination with the specific content of the technical solution.
本发明的描述中,参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。In the description of the present invention, reference to the terms "one embodiment," "some embodiments," "exemplary embodiment," "example," "specific example," or "some examples" or the like is meant to be used in conjunction with the embodiment. A particular feature or characteristic of the description or example is included in at least one embodiment or example of the present invention. In this specification, schematic representations of the above terms do not necessarily refer to the same embodiment or example. Furthermore, the particular features or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
参照图1,本发明实施例提供了一种基于亨利气体溶解度的船舶控制方法,本实施例可应用于服务器或者船舶控制平台的后台处理器。Referring to FIG. 1 , an embodiment of the present invention provides a ship control method based on Henry gas solubility, and this embodiment can be applied to a server or a background processor of a ship control platform.
在实施过程中,本实施例包括以下步骤:In the implementation process, this embodiment includes the following steps:
S11、获取船舶当前时刻的状态信息。具体地,本实施例可通过先获取由船舶舵角、船舶螺旋桨转速、GPS位置信息、船舶航向角和船舶艏向角等信息组成的船舶当前时刻的硬件数据,然后根据该硬件数据分析得到船舶当前时刻的状态信息。S11. Acquire the state information of the ship at the current moment. Specifically, in this embodiment, the hardware data of the ship at the current moment, which is composed of the ship's rudder angle, the ship's propeller speed, the GPS position information, the ship's heading angle, the ship's heading angle, etc., can be obtained first, and then the ship can be obtained by analyzing the hardware data. Status information at the current moment.
S12、构建船舶运动模型。S12, constructing a ship motion model.
在一些实施例中,本步骤可根据船舶的运动特征信息构建三自由度船舶运动模型。In some embodiments, this step may construct a three-degree-of-freedom ship motion model according to the motion characteristic information of the ship.
具体地,三自由度船舶运动模型可以为三自由度船舶操纵性运动模型,其具体如公式1 和公式2所示:Specifically, the three-degree-of-freedom ship motion model may be a three-degree-of-freedom ship maneuvering motion model, which is specifically shown in Formula 1 and Formula 2:
其中,η=[xpos,ypos]T和va=[vx,vy,vr]T分别为船舶的位置状态信息和速度状态信息;和分别为位置与速度的导数;xpos为船舶x方向的位置信息;ypos为船舶y方向的位置信息;vx为船舶x方向的速度信息;vy为船舶y方向的速度信息;vr为船舶的角速度信息;τ为船舶运动模型的推进器;τdistrub为干扰因素;CRB为科氏向心矩阵;CA为附加科氏向心矩阵;R为雅可比转换矩阵;MRB为质量矩阵;MA为附加质量矩阵。Wherein, η=[x pos , y pos ] T and v a = [v x , v y , v r ] T are the position state information and speed state information of the ship, respectively; and are the derivatives of position and speed respectively; x pos is the position information of the ship in the x direction; y pos is the position information of the ship in the y direction; v x is the speed information of the ship in the x direction; v y is the speed information of the ship in the y direction; v r is the angular velocity information of the ship; τ is the propeller of the ship motion model; τ distrub is the interference factor; C RB is the Coriolis centripetal matrix; C A is the additional Coriolis centripetal matrix; R is the Jacobian transformation matrix; M RB is the Mass matrix; M A is the additional mass matrix.
在船舶运动模型中,输入为推进器τ和干扰因素τdistrub的推力和力矩,输出为在x和y方向上的行进距离和船舶艏向角Ψ。In the ship motion model, the input is the thrust and moment of the thruster τ and the disturbance factor τ distrub , and the output is the traveled distance in the x and y directions and the ship's heading angle Ψ.
在完成上述模型的构建后,执行步骤S13。After completing the construction of the above model, step S13 is performed.
S13、根据当前时刻的状态信息结合所述船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息。S13. According to the state information at the current moment and the ship motion model, use the Henry gas solubility prediction method to predict the ship control information of the ship at the next moment.
具体地,气体溶解度受气体种类、压强、温度等因素影响,通常在高温环境下,气体溶解度低;在高压环境下,气体溶解度高。基于上述原理,运用亨利气体溶解度预测方式包括:Specifically, the gas solubility is affected by factors such as gas type, pressure, temperature, etc. Generally, in a high temperature environment, the gas solubility is low; in a high pressure environment, the gas solubility is high. Based on the above principles, using Henry's gas solubility prediction methods include:
假设在D维空间有C簇气体,气体总数为N,记为Xi=(1,2,…,N),初始化气体位置:Xi(t+1)=Xmin+r×(Xmax-Xmin)。Xmax和Xmin表示问题的限制范围,对于船舶,则表示舵角的约束范围,即Xmax=τmax、Xmin=τmin。Assuming that there are C clusters of gases in the D-dimensional space, the total number of gases is N, denoted as X i =(1,2,...,N), initialized gas position: X i (t+1)=X min +r×(X max -X min ). X max and X min represent the restricted range of the problem, and for ships, they represent the restricted range of the rudder angle, that is, X max =τ max , X min =τ min .
初始化亨利气体参数,其中,亨利气体参数包括亨利系数Hj、分压pi,j和气体类型数j (Ci);初始化过程为Hj(t)=l1×rand(0,1),pi,j=l2×rand(0,1)和Cj=l3×rand(0,1),l1、 l2和l3均为常数。Initialize the Henry gas parameters, where the Henry gas parameters include the Henry coefficient H j , the partial pressure p i,j and the number of gas types j (C i ); the initialization process is H j (t)=l 1 ×rand(0,1) , p i,j =l 2 ×rand(0,1) and C j =l 3 ×rand(0,1), and l 1 , l 2 and l 3 are all constants.
对若干个气体团簇进行评估和排序,确定符合预设要求的气体。Evaluate and rank several gas clusters to identify gases that meet preset requirements.
具体地,本步骤可通过先对若干个气体j团簇进行评估,确定每个气体j团簇对应类型中最高平衡状态的最佳气体,也就是最佳值;然后对最佳气体进行排序,确定若干个气体团簇对应组群的最优气体。Specifically, in this step, by first evaluating several gas j clusters, determine the best gas with the highest equilibrium state in the type corresponding to each gas j cluster, that is, the best value; and then sort the best gases, Determine the optimal gas for the group corresponding to several gas clusters.
根据符合预设要求的气体更新亨利气体参数,其中,亨利系数更新过程如公式3所示:The Henry gas parameters are updated according to the gas that meets the preset requirements, and the update process of the Henry coefficient is shown in Equation 3:
Hj(t+1)=Hj(t)×exp(-Cj×(1/T(t)-1/Tθ)) 公式3H j (t+1)=H j (t)×exp(-C j ×(1/T(t)-1/T θ )) Equation 3
其中,T(t)=exp(-t/iter);T为温度;Tθ=298.15;iter为迭代次数。Wherein, T(t)=exp(-t/iter); T is the temperature; T θ =298.15; iter is the number of iterations.
溶解度更新过程如公式4所示:The solubility update process is shown in Equation 4:
Si,j(t)=K×Hj(t+1)×pi,j(t) 公式4S i,j (t)=K×H j (t+1)×pi ,j (t) Equation 4
K为常数;Hj(t+1)为更新后的亨利系数;pi,j(t)为更新前的分压值。K is a constant; H j (t+1) is the Henry coefficient after updating; p i,j (t) is the partial pressure value before updating.
更新气体位置如公式5所示:The updated gas position is shown in Equation 5:
Xi(t+1)=Xi(t)×r×γ×(Xi,best(t)-Xi,j(t))+F×r×α×(Si,j(t)×Xbest(t)-Xi,j(t)) 公式5X i (t+1)=X i (t)×r×γ×(X i,best (t)-X i,j (t))+F×r×α×(S i,j (t) ×X best (t)-X i,j (t)) Equation 5
其中,为j簇气体i与团簇中气体的相互作用的能力;ε=0.05; F为改变搜索主体的方向并提供多样性,也就是正负;Fi,j为j类气体中气体i的适应度;Fbest为全习题最好的气体;Xi,best为j簇中最好的气体i;Xbest为在种群中最好的气体;α为j团气体i上的气体等于1;β为常数。r为0到1之间的随机数。in, is the ability of the j cluster gas i to interact with the gas in the cluster; ε=0.05; F is to change the direction of the search subject and provide diversity, that is, positive and negative; F i,j is the adaptation of the gas i in the j type of gas degree; F best is the best gas in the whole exercise; X i,best is the best gas i in j cluster; X best is the best gas in the population; α is the gas on j cluster gas i equal to 1; β is a constant. r is a random number between 0 and 1.
完成上述一次参数更新后,跳出气体团簇的局部最优,其具体如公式6所示:After completing the above one parameter update, the local optimum of the gas cluster jumps out, which is shown in Equation 6:
Nw=N×(rand(c2-c1)+c1) 公式6N w =N×(rand(c 2 -c 1 )+c 1 ) Equation 6
Nw为最差主体数;c1=0.1;c2=0.2;N表示气体总数。N w is the worst body number; c 1 =0.1; c 2 =0.2; N is the total number of gases.
通过公式7更新最差气体位置:The worst gas position is updated by Equation 7:
G(i,j)=Gmin(i,j)+r×(Gmax(i,j)-Gmin(i,j)) 公式7G (i,j) = Gmin(i,j) +r×( Gmax(i,j) -Gmin (i,j) ) Equation 7
G(i,j)为气体i在j团簇中的位置;r是随机数;Gmin(i,j)和Gmax(i,j)表示问题的范围限制,即Gmin(i,j)=Xmin、Gmax(i,j)=Xmax。G (i,j) is the position of gas i in j cluster; r is a random number; Gmin(i,j) and Gmax(i,j) represent the scope limit of the problem, namely Gmin(i,j ) =X min , G max(i,j) =X max .
迭代循环上述亨利气体溶解度预测方式的执行过程,并结合船舶运动模型,确定符合预设要求的气体的位置信息,其中,符合预设要求的气体的位置信息Xi为船舶控制信息τthrust。在执行上述步骤S13时,引入预测思 想,并设置公式8所示的适应度函数:The execution process of the above-mentioned Henry gas solubility prediction method is iteratively looped, and the position information of the gas that meets the preset requirements is determined in combination with the ship motion model, wherein the position information X i of the gas that meets the preset requirements is the ship control information τ thrust . When performing the above step S13, the prediction idea is introduced, and the fitness function shown in formula 8 is set:
其中,q为权重因子;Q为总的权重因子;Np为预测步数;fbest(j)为单次的适应度函数值;RREF=[Rref(j),Rref(j+1),…,Rref(j+Np)]T; SSTATE=[Sstate(j),Sstate(j+1),…,Sstate(j+Np)];Sstate(j)=[η v];Rref为参考轨迹。Among them, q is the weight factor; Q is the total weight factor; N p is the number of prediction steps; f best (j) is the single fitness function value; R REF =[R ref (j),R ref (j+1),…,R ref (j+N p )] T ; S STATE =[S state (j),S state (j+1),… , S state (j+N p )]; S state (j)=[η v]; R ref is the reference trajectory.
迭代循环上述步骤S13的执行过程,以得到最优船舶控制输入。The execution process of the above step S13 is iteratively looped to obtain the optimal ship control input.
S14、根据船舶控制信息控制船舶运动。S14, control the movement of the ship according to the ship control information.
具体地,将上述实施例应用于具体船舶控制过程,如图2所示,整个控制系统结构包括上位机1-1、下位机1-2、驱动机构1-3、传感器等硬件设备1-4和执行机构1-5;驱动机构1-3包括电动机及舵机控制器;传感器等硬件设备1-4包括GPS、光电编码器及绝对值角度传感器;执行机构1-5包括螺旋桨及舵机。Specifically, the above embodiment is applied to a specific ship control process. As shown in FIG. 2 , the entire control system structure includes a host computer 1-1, a lower computer 1-2, a drive mechanism 1-3, sensors and other hardware devices 1-4. And the actuator 1-5; the drive mechanism 1-3 includes the motor and the steering gear controller; the sensor and other hardware devices 1-4 include GPS, photoelectric encoder and absolute value angle sensor; the actuator 1-5 includes the propeller and the steering gear.
应用过程包括以下步骤:The application process includes the following steps:
步骤2.1:建立模型船运动模型;Step 2.1: Establish a model ship motion model;
步骤2.2:传感器等设备(1-4)测得的螺旋桨转速、舵角值、距离生成报文,传输到串口收发器进行反馈到上位机(1-1),将解析的结果传入船舶运动模型;采用是亨利气体溶解度预测算法进行下一步控制输入的计算;Step 2.2: The propeller speed, rudder angle value, and distance measured by sensors and other equipment (1-4) generate a message, which is transmitted to the serial transceiver for feedback to the host computer (1-1), and the analysis result is transmitted to the ship motion model; the Henry gas solubility prediction algorithm is used to calculate the next control input;
步骤2.3:通过串口收发器将计算得到的下一步航行所需的舵角及螺旋桨转速指令信息传入下位机(1-2);Step 2.3: Send the calculated rudder angle and propeller speed command information required for the next sailing to the lower computer (1-2) through the serial transceiver;
步骤2.4:下位机(1-2)串口收发器将接收到的螺旋桨转速指令信息和舵角指令信息进行解析成相应的转速控制信号及舵角控制信号,驱动电动机及舵机控制器工作,使螺旋桨及舵响应控制指令。Step 2.4: The serial transceiver of the lower computer (1-2) parses the received propeller speed command information and rudder angle command information into corresponding speed control signals and rudder angle control signals, and drives the motor and the steering gear controller to work, so that the The propeller and rudder respond to control commands.
如图3所示,D维空间有C簇气体,气体总数为N,记为Xi=(1,2,…,N),初始化气体位置:Xi(t+1)=Xmin+r×(Xmax-Xmin),按照此过程,结合船舶运动模型,气体位置信息Xi为船舶控制输入信息τthrust。As shown in Figure 3, there are C clusters of gases in the D-dimensional space, and the total number of gases is N, denoted as X i =(1,2,...,N), and the initialized gas position: X i (t+1)=X min +r ×(X max -X min ), according to this process, combined with the ship motion model, the gas position information X i is the ship control input information τ thrust .
初始化亨利气体参数,其中,亨利气体参数包括亨利系数Hj、分压pi,j和气体类型j(Ci);初始化过程为Hj(t)=l1×rand(0,1),pi,j=l2×rand(0,1)和Cj=l3×rand(0,1),l1、l2和l3均为常数。Initialize the Henry gas parameters, where the Henry gas parameters include Henry coefficient H j , partial pressure p i,j and gas type j(C i ); the initialization process is H j (t)=l 1 ×rand(0,1), p i,j =l 2 ×rand(0,1) and C j =l 3 ×rand(0,1), and l 1 , l 2 and l 3 are all constants.
步骤3.1:对每个j团簇进行评估,引入预测思想,设置公式8所示的适应度函数F,以确定在其类型中获得最高平衡状态的最优控制输入。然后,对气体进行排序,得到整个组群中的最优控制输入:Step 3.1: Evaluate each j-cluster, introduce the prediction idea, and set the fitness function F shown in Equation 8 to determine the optimal control input that obtains the highest equilibrium state among its types. Then, sort the gases to get the optimal control input across the group:
其中,q为权重因子;Q为总的权重因子;Np为预测步数;fbest(j)为单次的适应度函数值;RREF=[Rref(j),Rref(j+1),…,Rref(j+Np)]T; SSTATE=[Sstate(j),Sstate(j+1),…,Sstate(j+Np)];Sstate(j)=[η v];Rref为参考轨迹。Among them, q is the weight factor; Q is the total weight factor; N p is the number of prediction steps; f best (j) is the single fitness function value; R REF =[R ref (j),R ref (j+1),…,R ref (j+N p )] T ; S STATE =[S state (j),S state (j+1),… , S state (j+N p )]; S state (j)=[η v]; R ref is the reference trajectory.
步骤3.2:采用公式3更新亨利系数:Step 3.2: Update the Henry coefficient using Equation 3:
Hj(t+1)=Hj(t)×exp(-Cj×(1/T(t)-1/Tθ)) 公式3H j (t+1)=H j (t)×exp(-C j ×(1/T(t)-1/T θ )) Equation 3
其中,T(t)=exp(-t/iter);T为温度;Tθ=298.15;iter为迭代次数。Wherein, T(t)=exp(-t/iter); T is the temperature; T θ =298.15; iter is the number of iterations.
步骤3.3:采用公式4更新溶解度:Step 3.3: Update the solubility using Equation 4:
Si,j(t)=K×Hj(t+1)×pi,j(t) 公式4S i,j (t)=K×H j (t+1)×pi ,j (t) Equation 4
K为常数;Hj(t+1)为更新后的亨利系数;pi,j(t)为更新前的分压值。K is a constant; H j (t+1) is the Henry coefficient after updating; p i,j (t) is the partial pressure value before updating.
步骤3.4:采用公式5更新气体位置:Step 3.4: Update the gas position using Equation 5:
Xi(t+1)=Xi(t)×r×γ×(Xi,best(t)-Xi,j(t))+F×r×α×(Si,j(t)×Xbest(t)-Xi,j(t)) 公式5X i (t+1)=X i (t)×r×γ×(X i,best (t)-X i,j (t))+F×r×α×(S i,j (t) ×X best (t)-X i,j (t)) Equation 5
其中,为j簇气体i与团簇中气体的相互作用的能力;ε=0.05; F为改变搜索主体的方向并提供多样性,也就是正负;Fi,j为j类气体中气体i的适应度;Fbest为全习题最好的气体;Xi,best为j簇中最好的气体i;Xbest为在种群中最好的气体;α为j团气体i上的气体等于1;β为常数。r为0和1之间的随机数。in, is the ability of the j cluster gas i to interact with the gas in the cluster; ε=0.05; F is to change the direction of the search subject and provide diversity, that is, positive and negative; F i,j is the adaptation of the gas i in the j type of gas degree; F best is the best gas in the whole exercise; X i,best is the best gas i in j cluster; X best is the best gas in the population; α is the gas on j cluster gas i equal to 1; β is a constant. r is a random number between 0 and 1.
步骤3.5:采用公式6跳出气体团簇的局部最优:Step 3.5: Use Equation 6 to jump out of the local optima of the gas cluster:
Nw=N×(rand(c2-c1)+c1) 公式6N w =N×(rand(c 2 -c 1 )+c 1 ) Equation 6
Nw为最差主体数;c1=0.1;c2=0.2;N表示气体总数。N w is the worst body number; c 1 =0.1; c 2 =0.2; N is the total number of gases.
步骤3.6:采用公式7更新最差气体位置:Step 3.6: Update the worst gas position using Equation 7:
G(i,j)=Gmin(i,j)+r×(Gmax(i,j)-Gmin(i,j)) 公式7G (i,j) = Gmin(i,j) +r×( Gmax(i,j) -Gmin (i,j) ) Equation 7
G(i,j)为气体i在j团簇中的位置;r是随机数;Gmin(i,j)和Gmax(i,j)表示问题的范围限制,即Gmin(i,j)=Xmin、Gmax(i,j)=Xmax。G (i,j) is the position of gas i in j cluster; r is a random number; Gmin(i,j) and Gmax(i,j) represent the scope limit of the problem, namely Gmin(i,j ) =X min , G max(i,j) =X max .
步骤3.7:迭代循环步骤3.1,得到最优船舶控制输入。Step 3.7: Iteratively loop step 3.1 to obtain the optimal ship control input.
如图4所示,首先对船舶状态等进行初始化设置,通过下位机接收到船舶信息上传至上位机,再经过船舶亨利气体溶解度预测算法求解下一步运动控制指令。将控制器输入结果发送到下位机,之后发送到执行机构执行命令。最后进行判断,如果任务结束,保存数据,如果任务未完成,则循环执行任务,直到结束。As shown in Figure 4, firstly, initialize the ship status, etc., and upload the ship information received by the lower computer to the upper computer, and then solve the next motion control command through the ship Henry gas solubility prediction algorithm. Send the input result of the controller to the lower computer, and then send it to the actuator to execute the command. Finally, make a judgment. If the task ends, save the data. If the task is not completed, execute the task cyclically until the end.
综上所述,上述实施例通过采用亨利气体溶解度预测方式实时预测下一时刻的船舶控制信息,以提高预测过程的收敛速度,增加预判的手段,同时使得本实施例能够有效应用于多种类型的船舶运动控制过程。To sum up, the above embodiment uses the Henry gas solubility prediction method to predict the ship control information at the next moment in real time, so as to improve the convergence speed of the prediction process and increase the means of prediction, and at the same time, this embodiment can be effectively applied to a variety of type of ship motion control process.
本发明实施例提供了一种基于亨利气体溶解度的船舶控制系统,包括:An embodiment of the present invention provides a ship control system based on Henry's gas solubility, including:
获取模块,用于获取船舶当前时刻的状态信息;The acquisition module is used to acquire the status information of the ship at the current moment;
构建模块,用于构建船舶运动模型;Building blocks for building ship motion models;
预测模块,用于根据当前时刻的状态信息结合所述船舶运动模型,采用亨利气体溶解度预测方式预测船舶下一时刻的船舶控制信息;The prediction module is used for predicting the ship control information of the ship at the next moment by using the Henry gas solubility prediction method according to the state information at the current moment in combination with the ship motion model;
控制模块,用于根据所述船舶控制信息控制船舶运动。The control module is used for controlling the movement of the ship according to the ship control information.
本发明方法实施例的内容均适用于本系统实施例,本系统实施例所具体实现的功能与上述方法实施例相同,并且达到的有益效果与上述方法达到的有益效果也相同。The contents of the method embodiments of the present invention are all applicable to the system embodiments, and the specific functions implemented by the system embodiments are the same as the above-mentioned method embodiments, and the beneficial effects achieved are also the same as those achieved by the above-mentioned methods.
本发明实施例提供了一种基于亨利气体溶解度的船舶控制系统,包括:An embodiment of the present invention provides a ship control system based on Henry's gas solubility, including:
至少一个存储器,用于存储程序;at least one memory for storing programs;
至少一个处理器,用于加载所述程序以执行如图1所示的基于亨利气体溶解度的船舶控制方法。At least one processor for loading the program to execute the Henry's gas solubility-based ship control method as shown in FIG. 1 .
本发明方法实施例的内容均适用于本系统实施例,本系统实施例所具体实现的功能与上述方法实施例相同,并且达到的有益效果与上述方法达到的有益效果也相同。The contents of the method embodiments of the present invention are all applicable to the system embodiments, and the specific functions implemented by the system embodiments are the same as the above-mentioned method embodiments, and the beneficial effects achieved are also the same as those achieved by the above-mentioned methods.
本发明实施例提供了一种存储介质,其中存储有处理器可执行的程序,所述处理器可执行的程序在由处理器执行时用于执行图1所示的基于亨利气体溶解度的船舶控制方法。An embodiment of the present invention provides a storage medium, in which a processor-executable program is stored, and when executed by the processor, the processor-executable program is used to execute the Henry gas solubility-based ship control shown in FIG. 1 . method.
本发明实施例还公开了一种计算机程序产品或计算机程序,该计算机程序产品或计算机程序包括计算机指令,该计算机指令存储在计算机可读存介质中。计算机设备的处理器可以从存储介质读取该计算机指令,处理器执行该计算机指令,使得该计算机设备执行图1所示的基于亨利气体溶解度的船舶控制方法。The embodiment of the present invention also discloses a computer program product or computer program, where the computer program product or computer program includes computer instructions, and the computer instructions are stored in a computer-readable storage medium. The processor of the computer device may read the computer instructions from the storage medium, and the processor executes the computer instructions, so that the computer device executes the method for controlling a ship based on Henry gas solubility shown in FIG. 1 .
上面结合附图对本发明实施例作了详细说明,但是本发明不限于上述实施例,在所属技术领域普通技术人员所具备的知识范围内,还可以在不脱离本发明宗旨的前提下作出各种变化。此外,在不冲突的情况下,本发明的实施例及实施例中的特征可以相互组合。The embodiments of the present invention have been described in detail above in conjunction with the accompanying drawings, but the present invention is not limited to the above-mentioned embodiments, and within the scope of knowledge possessed by those of ordinary skill in the art, various Variety. Furthermore, the embodiments of the present invention and features in the embodiments may be combined with each other without conflict.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110170522.6A CN112947443B (en) | 2021-02-08 | 2021-02-08 | Ship control method, system and storage medium based on Henry gas solubility |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110170522.6A CN112947443B (en) | 2021-02-08 | 2021-02-08 | Ship control method, system and storage medium based on Henry gas solubility |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947443A CN112947443A (en) | 2021-06-11 |
CN112947443B true CN112947443B (en) | 2022-07-12 |
Family
ID=76243296
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110170522.6A Active CN112947443B (en) | 2021-02-08 | 2021-02-08 | Ship control method, system and storage medium based on Henry gas solubility |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947443B (en) |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9005404B2 (en) * | 2011-02-15 | 2015-04-14 | Purestream Services, Llc | Controlled-gradient, accelerated-vapor-recompression apparatus and method |
CN104808662B (en) * | 2015-03-13 | 2017-08-04 | 哈尔滨工程大学 | A data-driven control method for suppressing ship course disturbance |
CN107082107B (en) * | 2017-04-26 | 2019-07-09 | 武汉理工大学 | Ship trim intelligence control system and control method |
CN107577230B (en) * | 2017-08-16 | 2020-01-14 | 武汉理工大学 | Intelligent collision avoidance system for unmanned ship |
JP7177485B2 (en) * | 2019-03-15 | 2022-11-24 | 日立Astemo株式会社 | Control device |
CN110991615A (en) * | 2019-11-29 | 2020-04-10 | 广东工业大学 | Neural network training method based on TWO-GRSA-HGSO |
CN111008475B (en) * | 2019-12-04 | 2022-08-16 | 河海大学常州校区 | Hobbing carbon consumption model solving method based on chaos Henry gas solubility optimizer |
CN111427358B (en) * | 2020-04-16 | 2021-07-13 | 武汉理工大学 | Navigation trajectory control method, system and storage medium for ship formation |
CN111736595B (en) * | 2020-05-20 | 2022-04-22 | 武汉理工大学 | Control method, system and device for ship running track and storage medium |
CN111830972B (en) * | 2020-06-16 | 2021-09-21 | 武汉理工大学 | Ship autonomous berthing and departing control method, system and device and storage medium |
-
2021
- 2021-02-08 CN CN202110170522.6A patent/CN112947443B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN112947443A (en) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yan et al. | Robust adaptive sliding mode control of underactuated autonomous underwater vehicles with uncertain dynamics | |
CN108803321B (en) | Autonomous underwater vehicle track tracking control method based on deep reinforcement learning | |
US6246929B1 (en) | Enhanced stall and recovery control system | |
Chu et al. | Motion control of unmanned underwater vehicles via deep imitation reinforcement learning algorithm | |
Cui et al. | Autonomous boat driving system using sample‐efficient model predictive control‐based reinforcement learning approach | |
CN109164821A (en) | A kind of UAV Attitude training method and device | |
Lin | Adaptive critic autopilot design of bank-to-turn missiles using fuzzy basis function networks | |
CN109188909A (en) | Self-adaptive fuzzy optimal control method and system for ship course nonlinear discrete system | |
Nie et al. | Three‐Dimensional Path‐Following Control of a Robotic Airship with Reinforcement Learning | |
CN110658814B (en) | An adaptive ship motion modeling method applied to ship motion control | |
CN111767612B (en) | Model construction method, ship control device and electronic equipment | |
Zareb et al. | Evolutionary autopilot design approach for UAV quadrotor by using GA | |
CN117111594B (en) | An adaptive track control method for unmanned surface vehicle | |
Zhu et al. | Improved PER-DDPG based nonparametric modeling of ship dynamics with uncertainty | |
Okulski et al. | A novel neural network model applied to modeling of a tandem-wing quadplane drone | |
CN112947443B (en) | Ship control method, system and storage medium based on Henry gas solubility | |
CN114063453B (en) | Helicopter system control method, system, device and medium based on reinforcement learning | |
Shamsudin et al. | Recursive Gauss-Newton based training algorithm for neural network modelling of an unmanned rotorcraft dynamics | |
CN113959446A (en) | A Neural Network-based Robot Autonomous Logistics Transportation Navigation Method | |
Wang et al. | Parameters Optimization‐Based Tracking Control for Unmanned Surface Vehicles | |
CN116400691A (en) | A Novel Discrete-time Specified Performance Reinforcement Learning Unmanned Boat Course Tracking Control Method and System | |
JP4776205B2 (en) | Behavior learning control device | |
CN115097853A (en) | Unmanned aerial vehicle maneuvering flight control method based on fine-grained repetition strategy | |
Zhang et al. | Docking ship heave compensation system for loading operations based on a DDPG and PID hybrid control method using a judge network | |
Ferdaus et al. | Evolving fuzzy inference system based online identification and control of a quadcopter unmanned aerial vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |