CN107741744A - 一种海洋观测平台的最优艏向控制方法 - Google Patents
一种海洋观测平台的最优艏向控制方法 Download PDFInfo
- Publication number
- CN107741744A CN107741744A CN201711130259.8A CN201711130259A CN107741744A CN 107741744 A CN107741744 A CN 107741744A CN 201711130259 A CN201711130259 A CN 201711130259A CN 107741744 A CN107741744 A CN 107741744A
- Authority
- CN
- China
- Prior art keywords
- msub
- mtd
- observation platform
- mrow
- mtr
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000033001 locomotion Effects 0.000 claims abstract description 10
- 230000010354 integration Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims 1
- 238000011217 control strategy Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Other Liquid Machine Or Engine Such As Wave Power Use (AREA)
Abstract
本发明提供的是一种海洋观测平台的最优艏向控制方法。一:输入海洋观测平台的期望位置[xd yd];二:将海洋观测平台的位置信息的导数作为扩张状态观测器的输入,判断海流力方向βe所属象限;三:根据步骤二得到的海流力方向象限进行圆心的选择;四:控制海洋观测平台绕所选圆心pρ以半径ρ运动之最优艏向位置,且要保证在运动过程中海洋观测平台的艏向始终正对所选圆心pρ。本发明的最优艏向控制方法可以使海上观测平台的动力定位可以使用尽量少的推进器,使观测平台以最小转艏角达到最优艏向,使控制更加简单高效且节约能源。
Description
技术领域
本发明涉及的是一种海洋观测平台的控制方法,具体地说是一种纵横向对称的海洋观测平台的控制方法。
背景技术
随着海洋开发的深度和广度的扩大,深海观测技术的发展迅猛,海洋观测平台应运而生,在一些作业任务中,观测平台需要定点悬停,就要用到动力定位技术。动力定位技术的控制策略需要参考具体观测平台的具体特征而定,针对一些纵横方向和推进器布置方面完全对称的海洋观测平台而言,可以选择最优艏向,然后选择尽可能少的推进器来抵抗海流的干扰作用,这样便于控制且可以减少能源的消耗。同时在使海洋观测平台到达最优艏向的过程中,也需要设计一定的控制方法,使其以最小的转艏角度达到最优艏向。
Fossen对于动力定位***最优艏向的定义,以及其发展阶段的总结,提出了一种在未知扰动情况下的艏向自动调整。该方法的最主要特点就是不需要任何环境力的测量装置能够使船舶工作在最佳艏摇角度下,而这点对于海上作业***来说是很重要的,因为我们不可能准确计算得到环境作用力的大小和方向。但是可以采用扩张状态观测器(ESO)来获取未知海流的方向象限,然后再根据具体的海洋观测平台的几何对称特点选择合适的圆心,这样就可以使其转艏角度最小而达到最优艏向,节约了时间和能源。
发明内容
本发明的目的在于提供一种能够使控制更加简单,高效且节约能源的海洋观测平台的最优艏向控制方法。
本发明的目的是这样实现的:
步骤一:输入海洋观测平台的期望位置[xd yd];
步骤二:将海洋观测平台的位置信息的导数作为扩张状态观测器的输入,判断海流力方向βe所属象限;
步骤三:根据步骤二得到的海流力方向象限进行圆心的选择;
步骤四:控制海洋观测平台绕所选圆心pρ以半径ρ运动之最优艏向位置,且要保证在运动过程中海洋观测平台的艏向始终正对所选圆心pρ。
本发明还可以包括:
1、所述进行圆心的选择的具体选择依据为:
(1)当海洋观测平台所用推进器正车和倒车输出相同时,当海流力方向βe∈[-9090]时最优圆心取为pρ=(ρ,0),当海流力方向βe∈其他时最优圆心取为pρ=(-ρ,0);
当海洋观测平台在到达平衡状态时,海流干扰力在随体坐标系下取为:
w=[1 0 0]TFe=Φ1Fe,βe∈[-90 90]
w=[-1 0 0]TFe=Φ2Fe,βe∈其他;
其中w为海流干扰力,Φ1为方向向量,Φ2为方向向量,Fe海流力大小。
(2)当海洋观测平台所用推进器正车和倒车输出不同时,当海流力方向βe∈[-900]时最优圆心取为pρ=(0,ρ),当海流力方向βe∈其他时最优圆心取为pρ=(ρ,0);
当海洋观测平台在到达平衡状态时,海流干扰力在随体坐标系下取为:
w=[0 1 0]TFe=Φ3Fe,βe∈[-90 0]
w=[1 0 0]TFe=Φ1Fe,βe∈其他。
其中w为海流干扰力,Φ1为方向向量,Φ3为方向向量,Fe海流力大小。
2、所述扩张状态观测器为离散形式的扩张状态观测器,表示为:
式中,h为积分步长,β01,β02和β03为增益系数,δ为可调参数,b为补偿因子,z3(t)为估计的扰动,fal(e,α,δ)为幂次函数表示成下面形式:
3、所述判断海流力方向βe所属象限的具体规则为:
4、步骤四具体包括:取控制目标为:Pd=[xd yd ψd]T=[0 0 0]T,误差取为:e=P-Pd;其中Pd为期望位置,P为海洋观测平台实际位置,e为海洋观测平台实际位置和期望位置的偏差。因为只考虑水平面,故只考虑期望纵向位置xd、期望横向位置yd和期望艏向位置ψd。
构建解耦S面控制器,在纵向、横向和艏摇三个方向上各建立一个S面控制器,S面控制器表示如下:
f=Ku
其中,kp和kd为控制参数,e和为控制输入表示偏差和偏差变化率,u为控制输出,f是每个自由度需要的力或力矩,K为推进***可以提供的最大力或者力矩。
本发明提供了一种纵横向对称的海洋观测平台的艏向控制方法。观测平台在作业时候有时需要定点悬停,在复杂的海流环境下,实现定点悬停需要用到动力定位技术,针对本发明所述的纵横向和推进器布置完全对称的海洋观测平台,在进行动力定位时候,可以选择最优艏向来抵抗海流的干扰作用,同时在达到最优艏向的过程中可以选择最小的转艏角度。
本发明的技术方案的特点体现在:
1、将整个控制过程分为两个阶段:
(1)定位观测阶段:建立包含扩张状态观测器(Extended State Observer,ESO)的观测平台动力定位***(目标取为:[xd yd ψd]T=[0 0 0]T),根据ESO输出的扰动信息(只参考其方向)判断出海流方向所属象限。
(2)最优艏向控制阶段:根据获得的海流方向象限选定合适的圆心,在选定圆心后根据FOSSEN建立的最优艏向控制策略,引入S面控制器,建立观测平台艏向控制***,使平台以最小转艏角到达最优艏向。
2、所述定位观测阶段,主要是为了判断海流扰动的象限,具有如下特征:
将“扩张状态观测器”(Extended State Observer,ESO)引入控制器设计中,用于观测还流扰动。离散形式的扩张状态观测器可以表示成以下形式:
式中,z1(k)、z2(k)、z3(k)分别为被观测***的估计状态量、***的状态速度和加速度,y(k)为***的状态量,e为***的状态量偏差,h为积分步长,β01,β02和β03为增益系数,α01、α02和δ为可调参数,b为补偿因子,其中fal(e,α,δ)为幂次函数,可以表示成下面形式:
根据ESO输出结果进行海流力方向象限判断,具体规则如下:
3、当ESO判断出未知扰动海流力的方向象限后,根据所述的定位观测阶段获得的海流力方向象限判断结果进行最优作用圆心的选择,然后绕所选圆心运动到达最优艏向位置,(最优圆心指的是使观测平台以最小转艏角度达到最优艏向所做圆周运动的圆心)。在进行最优圆心选择时候分为两种情况,即分为海上观测平台推进器正车和倒车输出相同和不同两种情况:
(1)当所述海洋观测平台所用推进器正车和倒车输出相同时,则有:
此时,当海流力方向βe∈[-90 90]时最优圆心取为pρ=(ρ,0),当海流力方向βe∈其他时最优圆心取为pρ=(-ρ,0)。
那么当观测平台在到达平衡状态时,海流干扰力在随体坐标系下可取为:
w=[1 0 0]TFe=Φ1Fe,βe∈[-90 90]
w=[-1 0 0]TFe=Φ2Fe,βe∈其他
其中w为海流干扰力,Φ1为方向向量,Φ2为方向向量,Fe海流力大小。
(2)当所述海洋观测平台所用推进器正车和倒车输出不同时,则有:
此时,当海流力方向βe∈[-90 0]时最优圆心取为pρ=(0,ρ),当海流力方向βe∈其他时最优圆心取为pρ=(ρ,0)。
那么当观测平台在到达平衡状态时,海流干扰力在随体坐标系下可取为:
w=[0 1 0]TFe=Φ3Fe,βe∈[-90 0]
w=[1 0 0]TFe=Φ1Fe,βe∈其他
其中w为海流干扰力,Φ1为方向向量,Φ3为方向向量,Fe海流力大小。
4、当选择了最优圆心之后,需要控制所述的海洋观测平台绕所选圆心运动到最有艏向位置,同时在运动的过程中,需要保持平台的艏向始终正对圆心,具体内容如下:
取控制目标为Pd=[xd yd ψd]T=[0 0 0]T,误差取为:e=P-Pd;其中Pd为期望位置,P为海洋观测平台实际位置,e为海洋观测平台实际位置和期望位置的偏差。因为只考虑水平面,故只考虑期望纵向位置xd、期望横向位置yd和期望艏向位置ψd。
由于S控制器工程实用性更强,参数调整更加方便。构建解耦S面控制器,在纵向、横向和艏摇三个方向上各建立一个S面控制器,S面控制器可表示如下:
f=Ku
其中,kp和kd为控制参数,e和为控制输入,分别表示偏差和偏差变化率,u为控制输出,f是每个自由度需要的力或力矩,K为推进***可以提供的最大力或者力矩。
本发明主要是设计一种适用于纵横方向完全对称的海洋观测平台的动力定位***中的最优艏向控制方法,该方法可以使所述海洋观测平台在未知海流扰动情况下达到动力定位***定义的最优艏向,同时在达到最优艏向的过程中选择合适的圆心使其转艏角度最小,达到节约能源和高效的目的。
附图说明
图1、海洋观测平台受海流干扰力示意图。
图2、控制器结构图。
图3a-图3b、平衡状态海流干扰力在随体坐标系下示意图。
图4a-图4b、推进器正车和倒车输出相同达到最优艏向最小转艏角度。
图5a-图5b、推进器正车和倒车输出不同达到最优艏向最小转艏角度。
图6、最优艏向控制示意图。
图7、海洋观测平台的最优艏向控制方法流程图。
具体实施方式
下面举例对本发明做更详细的描述。
1、首先参照附图1介绍所述的最优艏向定义:
(1)假设海流是定常无旋的,那么可认为在海流干扰下的扰动力为:
w=[wu,wv,wr]T=[wu,wv,0]T
(2)定常流扰动力Fc在不同流向时对海洋观测平台在随体坐标系下的作用力:
式中:βe表示流扰动在固定坐标系下的角度,ψ表示当前艏向角。
则其总力可以表示为:
Fw=Fc|cos(βe-ψ)|+Fc|sin(βe-ψ)|
由上式可知,当βe=ψ时流扰动对平台的总作用力最小。则对于观测平台来说,环境最优艏向即为海流扰动力的方向。
2、设计控制策略,具体的控制器结构如附图2所示,将整个控制过程分为两个阶段:
(1)定位观测阶段:建立包含扩张状态观测器(Extended State Observer,ESO)的观测平台动力定位***(目标取为:[xd yd ψd]T=[0 0 0]T),根据ESO输出的扰动信息(只参考其方向)判断出海流方向所属象限。
(2)最优艏向控制阶段:根据获得的海流方向象限选定合适的圆心,在选定圆心后根据FOSSEN建立的最优艏向控制策略,引入S面控制器,建立观测平台艏向控制***,使平台以最小转艏角到达最优艏向。
3、定位观测阶段,主要是为了判断海流扰动的象限,具体特征如下:
将“扩张状态观测器”(Extended State Observer,ESO)引入控制器设计中,用于观测还流扰动。离散形式的扩张状态观测器可以表示成以下形式:
式中,z1(k)、z2(k)、z3(k)分别为被观测***的估计状态量、***的状态速度和加速度,y(k)为***的状态量,e为***的状态量偏差,h为积分步长,β01,β02和β03为增益系数,α01、α02和δ为可调参数,b为补偿因子,其中fal(e,α,δ)为幂次函数,可以表示成下面形式:
根据ESO输出结果进行海流力方向象限判断,具体规则如下:
4、对于海流方向象限判断完成后,就需要选择最优圆心,使所述海洋观测平台绕所选圆心到达最优艏向位置,具体选择最优圆心的原则如下:
在进行最优圆心选择时候分为两种情况,即分为海上观测平台推进器正车和倒车输出相同和不同两种情况:
(1)当所述海洋观测平台所用推进器正车和倒车输出相同时,则有:
此时,当海流力方向βe∈[-90 90]时最优圆心取为pρ=(ρ,0),当海流力方向βe∈其他时最优圆心取为pρ=(-ρ,0)。
如附图4a-图4b所示为在不同海流力干扰下不考虑推进器布置(即:只考虑圆心A)和考虑推进器布置(同时考虑圆心A和圆心B)时海洋观测平台运动到最优艏向所转过的最小转艏角度(初始状态平台艏向ψ=0)。从图可以看出当βe∈[-9090]时将圆心取为pρ=(-ρ,0)可大幅较小观测平台到达最优艏向的转艏角度从而提高效率。
那么当观测平台在到达平衡状态时,海流干扰力在随体坐标系下可取为:
w=[1 0 0]TFe=Φ1Fe,βe∈[-90 90]
w=[-1 0 0]TFe=Φ2Fe,βe∈其他
其中w为海流干扰力,Φ1为方向向量,Φ2为方向向量,Fe海流力大小。
(2)当所述海洋观测平台所用推进器正车和倒车输出不同时,则有:
此时,当海流力方向βe∈[-90 0]时最优圆心取为pρ=(0,ρ),当海流力方向βe∈其他时最优圆心取为pρ=(ρ,0)。
如附图5a-图5b所示为在不同海流力干扰下不考虑推进器布置(即:只考虑圆心A)和考虑推进器布置(同时考虑圆心A和圆心C)时海洋观测平台运动到最优艏向所转过的最小转艏角度(初始状态平台艏向ψ=0)。从图可以看出当βe∈[-900]时将圆心取为pρ=(0,ρ)可大幅较小观测平台到达最优艏向的转艏角度从而提高效率。
那么当观测平台在到达平衡状态时,海流干扰力在随体坐标系下可取为:
w=[0 1 0]TFe=Φ3Fe,βe∈[-90 0]
w=[1 0 0]TFe=Φ1Fe,βe∈其他
其中w为海流干扰力,Φ1为方向向量,Φ3为方向向量,Fe海流力大小。
5、当选择了最优圆心后,就控制海洋观测平台绕最优圆心运动到最优艏向位置,且在运动的过程中,需要保持平台的艏向始终正对圆心,具体特征如下:
取控制目标为:Pd=[xd yd ψd]T=[0 0 0]T,误差取为:e=P-Pd;其中Pd为期望位置,P为海洋观测平台实际位置,e为海洋观测平台实际位置和期望位置的偏差。因为只考虑水平面,故只考虑期望纵向位置xd、期望横向位置yd和期望艏向位置ψd。
由于S控制器工程实用性更强,参数调整更加方便。构建解耦S面控制器,在纵向、横向和艏摇三个方向上各建立一个S面控制器,S面控制器可表示如下:
f=Ku
其中,kp和kd为控制参数,e和为控制输入,分别表示偏差和偏差变化率,u为控制输出,f是每个自由度需要的力或力矩,K为推进***可以提供的最大力或者力矩。
6、所述的一种海洋观测平台的最优艏向控制方法的具体流程可参照权利说明书附图7,具体特征如下:
步骤一:给出海洋观测平台的期望位置[xd yd];
步骤二:将海洋观测平台的位置信息的导数作为扩张状态观测器的输入,判断海流力方向βe所属象限;
步骤三:根据上述海流力方向象限进行圆心的选择,具体的选择依据如下:
(1)当所述海洋观测平台所用推进器正车和倒车输出相同时,当海流力方向βe∈[-90 90]时最优圆心取为pρ=(ρ,0),当海流力方向βe∈其他时最优圆心取为pρ=(-ρ,0)。
(2)当所述海洋观测平台所用推进器正车和倒车输出不同时,当海流力方向βe∈[-90 0]时最优圆心取为pρ=(0,ρ),当海流力方向βe∈其他时最优圆心取为pρ=(ρ,0)。
步骤四:控制所述海洋观测平台绕所选圆心pρ以半径ρ运动之最优艏向位置,且要保证在运动过程中海洋观测平台的艏向始终正对所选圆心pρ。
本发明主要是提出一种在考虑回转体海洋观测平台推进器布置情况下的环境最优艏向控制方法,而最优位置的实现可参照Fossen的相关方法。
Claims (5)
1.一种海洋观测平台的最优艏向控制方法,其特征是:
步骤一:输入海洋观测平台的期望位置[xd yd];
步骤二:将海洋观测平台的位置信息的导数作为扩张状态观测器的输入,判断海流力方向βe所属象限;
步骤三:根据步骤二得到的海流力方向象限进行圆心的选择;
步骤四:控制海洋观测平台绕所选圆心pρ以半径ρ运动之最优艏向位置,且要保证在运动过程中海洋观测平台的艏向始终正对所选圆心pρ。
2.根据权利要求1所述的海洋观测平台的最优艏向控制方法,其特征是所述进行圆心的选择的具体选择依据为:
(1)当海洋观测平台所用推进器正车和倒车输出相同时,当海流力方向βe∈[-90 90]时最优圆心取为pρ=(ρ,0),当海流力方向βe∈其他时最优圆心取为pρ=(-ρ,0);
当海洋观测平台在到达平衡状态时,海流干扰力在随体坐标系下取为:
w=[1 0 0]TFe=Φ1Fe,βe∈[-90 90]
w=[-1 0 0]TFe=Φ2Fe,βe∈其他;
其中w为海流干扰力,Φ1为方向向量,Φ2为方向向量,Fe海流力大小;
(2)当海洋观测平台所用推进器正车和倒车输出不同时,当海流力方向βe∈[-90 0]时最优圆心取为pρ=(0,ρ),当海流力方向βe∈其他时最优圆心取为pρ=(ρ,0);
当海洋观测平台在到达平衡状态时,海流干扰力在随体坐标系下取为:
w=[0 1 0]TFe=Φ3Fe,βe∈[-90 0]
w=[1 0 0]TFe=Φ1Fe,βe∈其他。
其中w为海流干扰力,Φ1为方向向量,Φ3为方向向量,Fe海流力大小。
3.根据权利要求2所述的海洋观测平台的最优艏向控制方法,其特征是所述扩张状态观测器为离散形式的扩张状态观测器,表示为:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mi>e</mi>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<mi>y</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>+</mo>
<mi>h</mi>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>01</mn>
</msub>
<mi>e</mi>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>+</mo>
<mi>h</mi>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mn>02</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mn>01</mn>
</msub>
<mo>,</mo>
<msub>
<mi>&delta;</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mo>+</mo>
<mi>b</mi>
<mi>u</mi>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
<mo>-</mo>
<mi>h</mi>
<msub>
<mi>&beta;</mi>
<mn>03</mn>
</msub>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mo>(</mo>
<mi>e</mi>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mn>02</mn>
</msub>
<mo>,</mo>
<msub>
<mi>&delta;</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
式中,z1(k)、z2(k)、z3(k)分别为被观测***的估计状态量、***的状态速度和加速度,y(k)为***的状态量,e为***的状态量偏差,h为积分步长,β01,β02和β03为增益系数,α01、α02和δ为可调参数,b为补偿因子,fal(e,α,δ)为幂次函数表示成下面形式:
<mrow>
<mi>f</mi>
<mi>a</mi>
<mi>l</mi>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mo>|</mo>
<mi>e</mi>
<msup>
<mo>|</mo>
<mi>&alpha;</mi>
</msup>
<mi>sgn</mi>
<mo>(</mo>
<mi>e</mi>
<mo>)</mo>
<mo>,</mo>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
<mo>></mo>
<mi>&delta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mfrac>
<mi>e</mi>
<msup>
<mi>&delta;</mi>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>&alpha;</mi>
</mrow>
</msup>
</mfrac>
<mo>,</mo>
<mo>|</mo>
<mi>e</mi>
<mo>|</mo>
<mo>&le;</mo>
<mi>&delta;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
4.根据权利要求3所述的海洋观测平台的最优艏向控制方法,其特征是所述判断海流力方向βe所属象限的具体规则为:
<mrow>
<mi>k</mi>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>w</mi>
<mi>u</mi>
</msub>
<mo>></mo>
<mn>0</mn>
<mo>,</mo>
<msub>
<mi>w</mi>
<mi>v</mi>
</msub>
<mo>></mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>2</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>w</mi>
<mi>u</mi>
</msub>
<mo><</mo>
<mn>0</mn>
<mo>,</mo>
<msub>
<mi>w</mi>
<mi>v</mi>
</msub>
<mo>></mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>3</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>w</mi>
<mi>u</mi>
</msub>
<mo><</mo>
<mn>0</mn>
<mo>,</mo>
<msub>
<mi>w</mi>
<mi>v</mi>
</msub>
<mo><</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>4</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>w</mi>
<mi>u</mi>
</msub>
<mo>></mo>
<mn>0</mn>
<mo>,</mo>
<msub>
<mi>w</mi>
<mi>v</mi>
</msub>
<mo><</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>.</mo>
</mrow>
5.根据权利要求4所述的海洋观测平台的最优艏向控制方法,其特征是步骤四具体包括:取控制目标为:Pd=[xd yd ψd]T=[0 0 0]T,误差取为:e=P-Pd;其中Pd为期望位置,P为海洋观测平台实际位置,e为海洋观测平台实际位置和期望位置的偏差;因为只考虑水平面,故只考虑期望纵向位置xd、期望横向位置yd和期望艏向位置ψd;
构建解耦S面控制器,在纵向、横向和艏摇三个方向上各建立一个S面控制器,S面控制器表示如下:
<mrow>
<mi>u</mi>
<mo>=</mo>
<mn>2</mn>
<mo>/</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mi>exp</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
f=Ku
其中,kp和kd为控制参数,为偏差变化率,u为控制输出,f是每个自由度需要的力或力矩,K为推进***可以提供的最大力或者力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711130259.8A CN107741744B (zh) | 2017-11-15 | 2017-11-15 | 一种海洋观测平台的最优艏向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711130259.8A CN107741744B (zh) | 2017-11-15 | 2017-11-15 | 一种海洋观测平台的最优艏向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107741744A true CN107741744A (zh) | 2018-02-27 |
CN107741744B CN107741744B (zh) | 2020-09-25 |
Family
ID=61233317
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711130259.8A Active CN107741744B (zh) | 2017-11-15 | 2017-11-15 | 一种海洋观测平台的最优艏向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107741744B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109828462A (zh) * | 2019-02-18 | 2019-05-31 | 哈尔滨工程大学 | 波浪滑翔器变航速下自适应艏向控制器及控制方法 |
CN109901402A (zh) * | 2019-04-08 | 2019-06-18 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
WO2021022637A1 (zh) * | 2019-08-06 | 2021-02-11 | 南京赛沃夫海洋科技有限公司 | 一种基于改进遗传算法的无人艇路径规划方法及*** |
CN117369286A (zh) * | 2023-12-04 | 2024-01-09 | 中国海洋大学 | 一种海洋平台动力定位控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101763033A (zh) * | 2009-12-17 | 2010-06-30 | 哈尔滨工程大学 | 深潜救生艇多模态rbf神经网络自校正控制装置及方法 |
CN103345259A (zh) * | 2013-07-01 | 2013-10-09 | 哈尔滨工程大学 | 动力定位船舶实现定位旋转的几何坐标变换导引控制方法 |
CN104765370A (zh) * | 2015-04-15 | 2015-07-08 | 哈尔滨工业大学 | 有环境干扰下考虑侧滑角的uuv航迹视线导引法 |
CN105807789A (zh) * | 2016-03-24 | 2016-07-27 | 哈尔滨工程大学 | 基于t-s模糊观测器补偿的uuv控制方法 |
CN105867382A (zh) * | 2016-05-12 | 2016-08-17 | 哈尔滨工程大学 | 一种基于等效干扰补偿的船舶动力定位控制*** |
-
2017
- 2017-11-15 CN CN201711130259.8A patent/CN107741744B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101763033A (zh) * | 2009-12-17 | 2010-06-30 | 哈尔滨工程大学 | 深潜救生艇多模态rbf神经网络自校正控制装置及方法 |
CN103345259A (zh) * | 2013-07-01 | 2013-10-09 | 哈尔滨工程大学 | 动力定位船舶实现定位旋转的几何坐标变换导引控制方法 |
CN104765370A (zh) * | 2015-04-15 | 2015-07-08 | 哈尔滨工业大学 | 有环境干扰下考虑侧滑角的uuv航迹视线导引法 |
CN105807789A (zh) * | 2016-03-24 | 2016-07-27 | 哈尔滨工程大学 | 基于t-s模糊观测器补偿的uuv控制方法 |
CN105867382A (zh) * | 2016-05-12 | 2016-08-17 | 哈尔滨工程大学 | 一种基于等效干扰补偿的船舶动力定位控制*** |
Non-Patent Citations (4)
Title |
---|
LIANG PENG等: "Estimating the sea current and finding the optimal heading of an AUV through neural network motion control", 《PROCEEDINGS OF 1998 INTERNATIONAL SYMPOSIUM ON UNDERWATER TECHNOLOGY》 * |
ZHENG ZENG等: "A comparison of optimization techniques for AUV path planning in environments with ocean currents", 《ROBOTICS AND AUTONOMOUS SYSTEMS》 * |
杨树仁: "船舶航迹控制算法的研究与仿真", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
谢笑颖: "环境最优船舶区域动力定位方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109828462A (zh) * | 2019-02-18 | 2019-05-31 | 哈尔滨工程大学 | 波浪滑翔器变航速下自适应艏向控制器及控制方法 |
CN109901402A (zh) * | 2019-04-08 | 2019-06-18 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN109901402B (zh) * | 2019-04-08 | 2021-10-29 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
WO2021022637A1 (zh) * | 2019-08-06 | 2021-02-11 | 南京赛沃夫海洋科技有限公司 | 一种基于改进遗传算法的无人艇路径规划方法及*** |
CN117369286A (zh) * | 2023-12-04 | 2024-01-09 | 中国海洋大学 | 一种海洋平台动力定位控制方法 |
CN117369286B (zh) * | 2023-12-04 | 2024-02-09 | 中国海洋大学 | 一种海洋平台动力定位控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107741744B (zh) | 2020-09-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107741744A (zh) | 一种海洋观测平台的最优艏向控制方法 | |
CN103345259B (zh) | 动力定位船舶实现定位旋转的几何坐标变换导引控制方法 | |
CN112527018B (zh) | 一种欠驱动自主水下航行器的三维镇定控制方法 | |
CN106708064A (zh) | 一种水下机器人的垂直面控制方法 | |
CN110007606A (zh) | 一种考虑输入饱和的水面无人艇误差约束控制方法 | |
CN109116838A (zh) | 一种用于小型船的自动停泊辅助控制方法 | |
CN105204506A (zh) | 一种动力定位船舶铺管循迹导引方法 | |
CN113625544A (zh) | 一种波浪滑翔器的内外环pid路径跟踪控制方法 | |
CN112363393A (zh) | 无人艇动力定位的无模型自适应预设性能控制方法 | |
CN112925332B (zh) | 无人艇与水下无人潜器联合***的协同交会对接控制方法 | |
CN113147438B (zh) | 一种水下航行器无线充电***及控制方法 | |
Chen et al. | Adaptive backstepping fast terminal sliding mode control of dynamic positioning ships with uncertainty and unknown disturbances | |
Torben et al. | Control allocation for double-ended ferries with full-scale experimental results | |
Fu et al. | Research on thrust allocation of dynamic positioning ship with cycloidal propeller | |
Bjørnø et al. | Modeling, parameter identification and thruster-assisted position mooring of c/s inocean cat i drillship | |
David et al. | Coupled hydroplane and variable ballast control system for autonomous underwater vehicle altitude-keeping to variable seabed | |
CN111176292A (zh) | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 | |
Li et al. | Dynamics modeling and experiments of wave driven robot | |
Liu et al. | Real-time control allocation for autonomous surface vehicle using constrained quadratic programming | |
Zhang et al. | A new hybrid path planning method for the sailboat architecture wave glider in the wind field environment | |
Beal et al. | Unified scaling for flapping fins | |
Ding et al. | Based on disturbance observer of Air Cushion Vehicle course sliding backstepping control | |
Nakamura et al. | Motion Simulations of AUV “YUMEIRUKA” with X-rudder | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents | |
Wang et al. | AUV modeling and motion control strategy design |
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 |