CN110716572A - 基于pch模型的多艘动力定位船鲁棒同时镇定系统 - Google Patents

基于pch模型的多艘动力定位船鲁棒同时镇定系统 Download PDF

Info

Publication number
CN110716572A
CN110716572A CN201911053913.9A CN201911053913A CN110716572A CN 110716572 A CN110716572 A CN 110716572A CN 201911053913 A CN201911053913 A CN 201911053913A CN 110716572 A CN110716572 A CN 110716572A
Authority
CN
China
Prior art keywords
ship
dynamic positioning
controller
ships
pch
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.)
Pending
Application number
CN201911053913.9A
Other languages
English (en)
Inventor
杨仁明
崔建阔
周佩
张炳华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong Jiaotong University
Original Assignee
Shandong Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shandong Jiaotong University filed Critical Shandong Jiaotong University
Priority to CN201911053913.9A priority Critical patent/CN110716572A/zh
Publication of CN110716572A publication Critical patent/CN110716572A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

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

本发明公开了基于PCH模型的多艘动力定位船鲁棒同时镇定系统,涉及船舶控制技术领域。包括动力定位船、传感器模块、虚拟控制器、滤波器、自适应鲁棒同时镇定控制器、推力分配模块和推进器。本发明的有益效果在于:充分考虑海洋干扰和船舶模型不确定问题,使设计的多艘船舶同时镇定系统更加符合船舶海洋运动实际环境,有效解决了现有方法存在的问题。

Description

基于PCH模型的多艘动力定位船鲁棒同时镇定系统
技术领域
本发明涉及船舶控制技术领域,尤其是针对多艘动力定位船自适应鲁棒同时镇定系统控制研究。
背景技术
船舶动力定位技术在海洋开发和研究过程中发挥着举足轻重的作用,特别是随着海洋技术的不断发展,人们的活动范围逐渐从浅海延伸到深海,对运营安全、成本和效率提出了更高的要求;
众所周知,多艘船舶同时作业有提高运营效率,降低成本的优点,其协同作业的冗余特性可以提高整个动力定位系统的鲁棒性,并在执行危险任务时,可保障操作员的生命安全,相对于单艘动力定位船作业时间的有限性以及鲁棒性较差的缺点,多艘动力定位船舶协同作业有效弥补了上述缺陷,而且船舶在执行海底资源探测、海上搜救、在航补给、破冰护航等危险作业时,都需考虑多艘船舶同时镇定问题;
现有的方法针对单艘船镇定控制器的技术研究成果较为成熟,但该技术不能同时镇定多艘船,虽然有部分现有技术能同时镇定多艘船,但是设计的多艘船控制策略较为复杂,需分别对每艘船设计控制器,存在资源浪费、运行效率低等问题;
此外船舶模型本身存在不确定性、船舶运行过程中会产生参数摄动、海洋环境复杂多样等因素,鉴于以上实际问题,有必要对多艘动力定位船自适应鲁棒同时镇定系统进行研究。
发明内容
本发明的目的在于提供基于PCH模型的多艘动力定位船鲁棒同时镇定系统,能够充分考虑海洋干扰和船舶模型不确定问题,使设计的多艘船舶同时镇定系统更加符合船舶海洋运动实际环境,有效解决了现有方法存在的问题。
本发明为实现上述目的,通过以下技术方案实现:
基于PCH模型的多艘动力定位船鲁棒同时镇定系统,包括动力定位船、传感器模块、虚拟控制器、滤波器、自适应鲁棒同时镇定控制器、推力分配模块和推进器,包括如下步骤,
S1、设计多艘动力定位船自适应鲁棒同时镇定系统控制过程框,以获得船舶状态量的信息;
S2、建立动力定位船的三自由度运动学和低频动力学方程:
Figure BDA0002256034430000021
其中,式(1)中η是船舶在北东坐标系下的位置向量,
Figure BDA0002256034430000022
分别表示为纵荡位移、横荡位移、艏摇角度,v=[μ,υ,r]是随船坐标系下的速度向量,分别表示纵荡速度,横荡速度和艏摇角速度,τ∈R3×3表示为控制量。M∈R3×3是船体惯性矩阵,D∈R3×3是线性水阻尼矩阵,并且w为外界干扰,海洋环境变化缓慢,视为定常干扰,
Figure BDA0002256034430000023
是坐标转换矩阵,满足:
Figure BDA0002256034430000024
为满足所设计观测器系统稳定要求,引入虚拟控制器,将模型(1)转换为:
Figure BDA0002256034430000025
其中
S3、根据S2所建立方程,依据系统的能量结构,基于能量实现方法将方程等价为船舶PCH模型:
Figure BDA0002256034430000032
S4、根据S3所建立PCH模型和Hamilton系统同时镇定理论,设置多艘动力定位船的PCH系统:
Figure BDA0002256034430000033
把上述M个系统分成两组,
Figure BDA0002256034430000034
Figure BDA0002256034430000035
进一步的设计同时镇定控制器,
Figure BDA0002256034430000036
且系统满足Ra(X1)+K11(X1,X1)>0,Rb(X2)-K22(X2,X2)>0
其中
Figure BDA0002256034430000037
S5、考虑船舶模型运行过程中产生的参数摄动等不确定因素,设置多艘动力定位船的PCH系统变为:
Figure BDA0002256034430000041
Figure BDA0002256034430000042
其中,pa,pb分别表示两艘船PCH模型中结构参数不确定性的参数向量,
进一步设计自适应同时镇定控制器为:
其中θ代表未知常数向量pa,pb
Figure BDA0002256034430000044
是θ的估计值,Q>0为自适应增益矩阵且是一个正定常数矩阵。
在自适应同时镇定控制器(10)作用下,系统(8)、(9)是渐进稳定的,并且系统满足:
(i)
Figure BDA0002256034430000045
(ii)[Ji(xi,pi)-Ri(xi,pi)]△Hi(xi,pi)=gi(xi)Φθ,(i=1,2,...,M) (12)
其中
Figure BDA0002256034430000046
Φ>0是正定矩阵;
S6、考虑船舶海洋环境干扰因素,设置多艘动力定位船的PCH系统变为:
Figure BDA0002256034430000047
Figure BDA0002256034430000051
进一步设计自适应鲁棒同时镇定控制器为
Figure BDA0002256034430000052
将控制器(15)代入到系统(13)、(14)得到:
Figure BDA0002256034430000053
构造罚函数z,系统的L2增益(由w到z)不大于给定的γ,并且当w=0时,系统(13)、(14)可同时镇定;
S7、对自适应鲁棒同时镇定控制器进行仿真验证,进一步验证准确性。
对比现有技术,本发明的有益效果在于:
1、基于成熟的Hamilton同时镇定控制理论,直接从非线性角度出发,并考虑船舶运行过程中会产生参数摄动以及受到海洋环境干扰的影响,设计单一的同时镇定控制器,使其控制多艘船,从而提高多艘船舶之间的运行效率以及鲁棒性。
2、在该控制律下多艘动力定位船可以稳定到期望位置且艏摇角速度、纵向速度、横向速度都收敛到零。
附图说明:
图1为本发明多艘动力定位船自适应鲁棒同时镇定系统控制过程框图。
图2为本发明三自由度动力定位船运动模型示意图。
图3为本发明三艘动力定位船纵荡位置的变化曲线。
图4为本发明三艘动力定位船横荡位置的变化曲线。
图5为本发明三艘动力定位船艏向角度的变化曲线。
图6为本发明三艘动力定位船纵荡速度的变化曲线。
图7为本发明三艘动力定位船横荡速度的变化曲线。
图8为本发明三艘动力定位船艏向角速度的变化曲线。
具体实施方式
如图所示,下面结合具体实施例,阐述本发明。应理解,这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解,在阅读了本发明讲授的内容之后,本领域技术人员可以对本发明作各种改动或修改,这些等价形式同样落于本申请所限定的范围。
实施例:
如图1所示,本发明所述是基于PCH模型的多艘动力定位船鲁棒同时镇定系统,包括动力定位船、传感器模块、虚拟控制器、滤波器、自适应鲁棒同时镇定控制器、推力分配模块和推进器,动力定位船所受合力由环境干扰力和推进器所提供的推力两部分组成,传感器是由GPS、罗经和速度传感器组成,所述GPS采集船舶的位置,所述罗经艏向角,所述速度传感器采集速度信息,将采集到的船舶状态量输入到虚拟控制器中,此时输出的状态量为x1、x2,由于虚拟控制器输出的信息存在噪声,因此不能直接反馈到控制器系统中,需经过滤波器的去噪处理,才能将船舶运动状态量信息反馈到控制器系统中,由于船舶运行过程中会产生参数摄动以及受到海洋环境干扰因素,因此需要设置自适应鲁棒同时镇定控制器,根据预先设定的期望状态值以及多艘船的运动状态量来对推力分配模块进行控制,从而对多艘船舶姿态的控制,实现多艘船同时镇定的效果,包括如下步骤,
S1、设计多艘动力定位船自适应鲁棒同时镇定系统控制过程框,以获得船舶状态量的信息;
S2、建立动力定位船的三自由度运动学和低频动力学方程:
Figure BDA0002256034430000071
其中,式(1)中η是船舶在北东坐标系下的位置向量,
Figure BDA0002256034430000072
分别表示为纵荡位移、横荡位移、艏摇角度,v=[μ,υ,r]是随船坐标系下的速度向量,分别表示纵荡速度,横荡速度和艏摇角速度,τ∈R3×3表示为控制量。M∈R3×3是船体惯性矩阵,D∈R3×3是线性水阻尼矩阵,并且w为外界干扰,海洋环境变化缓慢,视为定常干扰,
Figure BDA0002256034430000073
是坐标转换矩阵,满足:
为满足所设计观测器系统稳定要求,引入虚拟控制器,将模型(1)转换为:
Figure BDA0002256034430000075
其中
Figure BDA0002256034430000076
S3、根据S2所建立方程,依据系统的能量结构,基于能量实现方法将方程等价为船舶PCH模型:
Figure BDA0002256034430000077
S4、根据S3所建立PCH模型和Hamilton系统同时镇定理论,设置多艘动力定位船的PCH系统:
把上述M个系统分成两组,
Figure BDA0002256034430000082
Figure BDA0002256034430000083
进一步的设计同时镇定控制器,
Figure BDA0002256034430000084
且系统满足Ra(X1)+K11(X1,X1)>0,Rb(X2)-K22(X2,X2)>0
其中
Figure BDA0002256034430000085
S5、考虑船舶模型运行过程中产生的参数摄动等不确定因素,设置多艘动力定位船的PCH系统变为:
Figure BDA0002256034430000086
其中,pa,pb分别表示两艘船PCH模型中结构参数不确定性的参数向量,
进一步设计自适应同时镇定控制器为:
Figure BDA0002256034430000091
其中θ代表未知常数向量pa,pb是θ的估计值,Q>0为自适应增益矩阵且是一个正定常数矩阵。
在自适应同时镇定控制器(10)作用下,系统(8)、(9)是渐进稳定的,并且系统满足:
(i)
(ii)[Ji(xi,pi)-Ri(xi,pi)]△Hi(xi,pi)=gi(xi)Φθ,(i=1,2,...,M) (12)
其中Φ>0是正定矩阵;
S6、考虑船舶海洋环境干扰因素,设置多艘动力定位船的PCH系统变为:
Figure BDA0002256034430000095
进一步设计自适应鲁棒同时镇定控制器为
Figure BDA0002256034430000097
将控制器(15)代入到系统(13)、(14)得到:
构造罚函数z,系统的L2增益(由w到z)不大于给定的γ,并且当w=0时,系统(13)、(14)可同时镇定;
S7、对自适应鲁棒同时镇定控制器进行仿真验证,进一步验证准确性。
本发明仿真采用的是三艘全驱动动力定位船舶模型Cybership II,在仿真时考虑船舶运行过程中会产生参数摄动、船舶模型不确定以及船舶受海洋干扰因素,对于三艘船的的期望位置均为(0m/s,0m/s,0°),船1的初始位置(10m,5m,5°),船1的初始速度(1m/s,0.8m/s,2rad/s)。船2的初始位置(12m,8m,7°),船2的初始速度(1.2m/s,1m/s,3rad/s)。船3的初始位置(15m,10m,9°),船3的初始速度(1.5m/s,1.2m/s,4rad/s)。
如图3至图8所示,通过对仿真曲线和数据分析可以看出,本发明所提出的一种基于PCH模型的多艘动力定位船自适应鲁棒同时镇定系统控制器设计方法,能够在存在海洋环境干扰以及船舶模型参数不确定的情况下,使两艘船在短时间内趋于期望的位置,速度也都同时趋向于0,达到了同时镇定的效果。

Claims (1)

1.基于PCH模型的多艘动力定位船鲁棒同时镇定系统,包括动力定位船、传感器模块、虚拟控制器、滤波器、自适应鲁棒同时镇定控制器、推力分配模块和推进器,其特征在于:包括如下步骤,
S1、设计多艘动力定位船自适应鲁棒同时镇定系统控制过程框,以获得船舶状态量的信息;
S2、建立动力定位船的三自由度运动学和低频动力学方程:
Figure FDA0002256034420000011
其中,式(1)中η是船舶在北东坐标系下的位置向量,
Figure FDA0002256034420000012
分别表示为纵荡位移、横荡位移、艏摇角度,v=[μ,υ,r]是随船坐标系下的速度向量,分别表示纵荡速度,横荡速度和艏摇角速度,τ∈R3×3表示为控制量。M∈R3×3是船体惯性矩阵,D∈R3×3是线性水阻尼矩阵,并且w为外界干扰,海洋环境变化缓慢,视为定常干扰,是坐标转换矩阵,满足:
Figure FDA0002256034420000014
为满足所设计观测器系统稳定要求,引入虚拟控制器,将模型(1)转换为:
其中
Figure FDA0002256034420000016
S3、根据S2所建立方程,依据系统的能量结构,基于能量实现方法将方程等价为船舶PCH模型:
Figure FDA0002256034420000017
S4、根据S3所建立PCH模型和Hamilton系统同时镇定理论,设置多艘动力定位船的PCH系统:
Figure FDA0002256034420000021
把上述M个系统分成两组,
Figure FDA0002256034420000022
Figure FDA0002256034420000023
进一步的设计同时镇定控制器,
Figure FDA0002256034420000024
且系统满足Ra(X1)+K11(X1,X1)>0,Rb(X2)-K22(X2,X2)>0
其中
S5、考虑船舶模型运行过程中产生的参数摄动等不确定因素,设置多艘动力定位船的PCH系统变为:
Figure FDA0002256034420000026
其中,pa,pb分别表示两艘船PCH模型中结构参数不确定性的参数向量,
进一步设计自适应同时镇定控制器为:
其中θ代表未知常数向量pa,pb是θ的估计值,Q>0为自适应增益矩阵且是一个正定常数矩阵。
在自适应同时镇定控制器(10)作用下,系统(8)、(9)是渐进稳定的,并且系统满足:
(i)
Figure FDA0002256034420000033
(ii)[Ji(xi,pi)-Ri(xi,pi)]△Hi(xi,pi)=gi(xi)Φθ,(i=1,2,...,M) (12)
其中
Figure FDA0002256034420000034
Φ>0是正定矩阵;
S6、考虑船舶海洋环境干扰因素,设置多艘动力定位船的PCH系统变为:
Figure FDA0002256034420000036
进一步设计自适应鲁棒同时镇定控制器为
Figure FDA0002256034420000037
将控制器(15)代入到系统(13)、(14)得到:
Figure FDA0002256034420000041
构造罚函数z,系统的L2增益(由w到z)不大于给定的γ,并且当w=0时,系统(13)、(14)可同时镇定;
S7、对自适应鲁棒同时镇定控制器进行仿真验证,进一步验证准确性。
CN201911053913.9A 2019-10-31 2019-10-31 基于pch模型的多艘动力定位船鲁棒同时镇定系统 Pending CN110716572A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911053913.9A CN110716572A (zh) 2019-10-31 2019-10-31 基于pch模型的多艘动力定位船鲁棒同时镇定系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911053913.9A CN110716572A (zh) 2019-10-31 2019-10-31 基于pch模型的多艘动力定位船鲁棒同时镇定系统

Publications (1)

Publication Number Publication Date
CN110716572A true CN110716572A (zh) 2020-01-21

Family

ID=69213579

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911053913.9A Pending CN110716572A (zh) 2019-10-31 2019-10-31 基于pch模型的多艘动力定位船鲁棒同时镇定系统

Country Status (1)

Country Link
CN (1) CN110716572A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112276952A (zh) * 2020-10-23 2021-01-29 山东交通学院 一种多机器人系统的鲁棒同时镇定方法及系统
CN113650020A (zh) * 2021-09-15 2021-11-16 山东交通学院 一种机械臂系统有限时间自适应镇定控制方法和系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20180231972A1 (en) * 2014-10-03 2018-08-16 Infinium Robotics Pte Ltd System for performing tasks in an operating region and method of controlling autonomous agents for performing tasks in the operating region
CN108519740A (zh) * 2018-05-05 2018-09-11 曲阜师范大学 一种全状态约束机械臂轨迹跟踪的协同控制方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20180231972A1 (en) * 2014-10-03 2018-08-16 Infinium Robotics Pte Ltd System for performing tasks in an operating region and method of controlling autonomous agents for performing tasks in the operating region
CN108519740A (zh) * 2018-05-05 2018-09-11 曲阜师范大学 一种全状态约束机械臂轨迹跟踪的协同控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
PEI ZHOU 等: "Adaptive Robust Simultaneous Stabilization of Two Dynamic Positioning Vessels Based on a Port-Controlled Hamiltonian (PCH) Model", 《ENERGIES》 *
吴金龙: "《船用导航仪器》", 31 August 2018, 沈阳:辽宁科学技术出版社 *
徐海祥: "《船舶动力定位系统原理》", 31 December 2016, 北京:国防工业出版社 *
王玉振 等: "非线性哈密顿控制系统输出反馈同时镇定", 《山东大学学报(工学版)》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112276952A (zh) * 2020-10-23 2021-01-29 山东交通学院 一种多机器人系统的鲁棒同时镇定方法及系统
CN112276952B (zh) * 2020-10-23 2022-02-08 山东交通学院 一种多机器人系统的鲁棒同时镇定方法及系统
CN113650020A (zh) * 2021-09-15 2021-11-16 山东交通学院 一种机械臂系统有限时间自适应镇定控制方法和系统

Similar Documents

Publication Publication Date Title
CN109753068B (zh) 一种考虑通信情况的多usv群体协同避碰规划方法
Pérez et al. Mathematical Ship Modeling for Control Applications.
CN109656143B (zh) 一种海面全驱动船舶的自适应跟踪控制方法及系统
CN109917657B (zh) 动力定位船舶的抗干扰控制方法、装置与电子设备
Townsend et al. Control strategies for marine gyrostabilizers
Park et al. An experimental study on vertical motion control of a high-speed planing vessel using a controllable interceptor in waves
Yan et al. Diving control of underactuated unmanned undersea vehicle using integral-fast terminal sliding mode control
CN110333658A (zh) 一种带输入约束和漂角补偿的欠驱动船舶航向控制方法
CN110716572A (zh) 基于pch模型的多艘动力定位船鲁棒同时镇定系统
CN110244556A (zh) 基于期望航向修正的欠驱动船舶航向控制方法
CN113741433A (zh) 一种水面无人船的分布式编队方法
Awad et al. Ship roll damping via direct inverse neural network control system
Dai et al. Dual closed loop AUV trajectory tracking control based on finite time and state observer
CN110515387A (zh) 一种水面船舶漂角补偿非线性航向控制方法
Zhang et al. Real-time simulation of a rescue ship maneuvering in short-crested irregular waves
Xu et al. Dynamic positioning with roll-pitch motion control for a semi-submersible
CN111291453A (zh) 一种船舶的水动力确定方法
CN115686008A (zh) 基于指令滤波反步法的船舶动力定位辅助锚泊系统设计
Ding et al. Automatic Berthing Based on Reinforcement Learning and Feedback Control
CN111651943B (zh) 一种船舶运动控制方法、终端设备及存储介质
CN115016465A (zh) 一种考虑舵的饱和及死区特性的自主水下航行器控制方法
Carletti et al. Roll damping and heading control of a marine vessel by fins-rudder VSC
Dantas et al. AUV control in the diving plane subject to waves
Nguyen et al. Modelling and Control of a Model Scaled Surface Vessel with Twin Propellers, Single Rudder and Two Side Thrusters
Schubert et al. Energy demand of vessels depending on current wind conditions

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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20200121