CN110045726B - 带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** - Google Patents
带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** Download PDFInfo
- Publication number
- CN110045726B CN110045726B CN201811450755.6A CN201811450755A CN110045726B CN 110045726 B CN110045726 B CN 110045726B CN 201811450755 A CN201811450755 A CN 201811450755A CN 110045726 B CN110045726 B CN 110045726B
- Authority
- CN
- China
- Prior art keywords
- ship
- dynamic positioning
- actuator
- time
- control
- 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
- 230000007246 mechanism Effects 0.000 claims abstract description 20
- 238000001514 detection method Methods 0.000 claims abstract description 11
- 238000013461 design Methods 0.000 claims abstract description 5
- 230000007613 environmental effect Effects 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000013016 damping Methods 0.000 claims description 3
- 230000002441 reversible effect Effects 0.000 claims description 3
- 230000002123 temporal effect Effects 0.000 claims description 3
- 238000012795 verification Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 5
- 238000000034 method Methods 0.000 abstract description 5
- 230000006641 stabilisation Effects 0.000 abstract description 4
- 238000011105 stabilization Methods 0.000 abstract description 4
- 230000000087 stabilizing effect Effects 0.000 abstract description 4
- 230000008569 process Effects 0.000 abstract description 2
- 229920006395 saturated elastomer Polymers 0.000 abstract description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000004873 anchoring Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 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
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
本发明提供了一种带有时滞和饱和的欠驱动船舶有限时间动力定位控制***,包括海洋干扰(1)、动力定位船(2)、执行机构(3)、传感器***(4)、位置传感器(5)、速度传感器(6)、状态观测器(7)、有限时间镇定控制器(8)、时滞补偿器(9)、执行器饱和补偿器(10)、故障检测观测器(11)、执行机构故障补偿器(12)、时间间隔测量模块(13)。本发明适用于欠驱动和执行器饱和的动力定位船舶在恶劣海洋干扰下的动力定位过程,考虑到船舶运动中环境干扰和执行机构故障问题,设计一种有限时间镇定的控制***,减少了船舶动力定位***的定位时间,在执行机构输入受限情况下能够达到较好的控制效果。
Description
技术领域
本发明涉及船舶控制技术领域,尤其是针对实际船舶动力定位***在欠驱动和执行器饱和情形下设计的一种在有外部干扰情况下快速镇定的姿态控制***。
背景技术
随着海洋经济的快速发展,人类对海洋的探索和开采逐年加深。由于深海环境的复杂多变,使得作业船舶或平台需要更高的定位精度,传统的作业工具由于其自身的局限性,如锚泊操作复杂、机动性能差等缺点,已经不能满足现代定位精度的要求。因此,研究船舶动力定位控制问题对于开采海洋资源振兴国家经济具有越来越重要的现实意义。
中国专利CN108490946A提出了一种基于RBF神经网络补偿的船舶动力定位滑模控制***,该专利考虑了船舶运动中的未建模动态、模型不确定、环境干扰和执行机构输入饱和问题,提高船舶动力定位***的抗干扰能力和定位精度。但是未考虑到船舶自身执行机构不确定故障,以及执行机构所产生的时滞现象。
发明内容
本发明的目的是提供一种带有时滞和饱和的欠驱动船舶有限时间动力定位控制***,考虑到执行机构时滞和未知故障补偿,使控制***更加符合船舶海洋运动环境。
为实现上述目的,本发明采用下述技术方案:
带有时滞和饱和的欠驱动船舶有限时间动力定位控制***,包括动力定位船舶、传感器模块、状态观测器和执行机构,动力定位船舶所受合力由海洋干扰和执行机构所提供的推力两部分组成;传感器模块实时采集动力定位船舶的位置和艏向角信息η以及线速度和角速度信息v,并将采集到的信息传递给状态观测器,还包括:
时滞补偿器,得到时间间隔测量模块传来的位置和速度信号后,经过时滞补偿器,得到带有时滞项的位置和速度信号,并将其传递给有限时间跟踪控制器;
执行器饱和补偿器,控制信号τ经过有限时间跟踪控制器后得到的控制向量传递给执行器饱和补偿器,得到输入饱和条件下的控制量sat(τi),并将其传递给故障检测观测器;
故障检测观测器,如果故障检测观测器观测到执行机构正常运行,则将控制信号sat(τi)直接传递给动力定位船舶;若观测到执行机构发生故障,则将控制信号sat(τi)传递给执行机构故障补偿器,再将产生的补偿量传递给动力定位船舶,最终使船舶运动到期望位姿状态。
进一步地,所述动力定位船舶的三自由度低频运动模型为:
式中,R(ψ)为旋转矩阵,其定义为且满足特性R-1(ψ)=RT(ψ),M为惯量矩阵,是可逆的正定对称阵;D为线性阻尼阵,也是正定矩阵;τ为控制输入向量,d(t)是未知的扰动项,代表风、浪、流环境因素对船舶产生的综合恒值干扰力和力矩。
进一步地,所述状态观测器形式如下:
式中,β(x1)=R(ψ)M-1,Td=R(ψ)M-1ξ(t),
为了保证有限的时间稳定性,引入以下辅助函数
进一步地,所述有限时间跟踪控制器控制律设计为:
u=un(t)+ua(t)
ua(t)=-κsggn(z)||un(t)||
sat(τi)=τi(t)+θ(t)
进一步地,所述执行机构故障补偿器的故障补偿量:
发明内容中提供的效果仅仅是实施例的效果,而不是发明所有的全部效果,上述技术方案中的一个技术方案具有如下优点或有益效果:
本发明设计控制器考虑到了船舶执行机构的时滞、饱和和故障问题,同时能够使***在有限时间内实现镇定,目的是对动力定位船舶进行点镇定,所提出的有限时间控制***能够较为准确的控制出船舶运动过程,为动力定位作业提供了方便。
附图说明
图1是船舶动力定位控制***总体结构图;
图2是动力定位船舶在控制器作用下的运动曲线;
图3是动力定位船舶横向位移和速度曲线;
图4是动力定位船舶纵向位移和速度曲线;
图5是动力定位船舶艏向角转动角度及角速度曲线;
1、海洋干扰,2、动力定位船执行机构,3、执行机构,4、传感器***,5、位置传感器,6、速度传感器,7、状态观测器,8、有限时间镇定控制器,9、时滞补偿器,10、执行器饱和补偿器,11、故障检测观测器,12、执行机构故障补偿器,13、时间间隔测量模块。
具体实施方式
为能清楚说明本方案的技术特点,下面通过具体实施方式,并结合其附图,对本发明进行详细阐述。下文的公开提供了许多不同的实施例或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。此外,本发明可以在不同例子中重复参考数字和/或字母。这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施例和/或设置之间的关系。应当注意,在附图中所图示的部件不一定按比例绘制。本发明省略了对公知组件和处理技术及工艺的描述以避免不必要地限制本发明。
如图1所示,本发明提供了一种带有时滞和饱和的欠驱动船舶有限时间动力定位控制***。包括海洋干扰(1)、动力定位船(2)、执行机构(3)、传感器***(4)、位置传感器(5)、速度传感器(6)、状态观测器(7)、有限时间镇定控制器(8)、时滞补偿器(9)、执行器饱和补偿器(10)、故障检测观测器(11)、执行机构故障补偿器(12)、时间间隔测量模块(13)。
动力定位船舶(2)所受合力基本由海洋干扰(1)和执行机构(3)所提供的推力两部分组成。传感器***(4)包括位置传感器(5)和速度传感器(6),实时采集动力定位船舶(2)的位置和艏向角信息η以及线速度和角速度信息v,并将采集到的信息传递给状态观测器(7);
3)由于执行机构(3)所带来的时滞问题,在得到时间间隔测量模块(13)传来的信号后,经过时滞补偿器,得到带有时滞项的位置和速度信号,并将其传递给有限时间跟踪控制器(8);
5)由于执行机构(3)的物理限制,控制信号τ受到饱和值的限制,信号经过有限时间跟踪控制器(8)后得到的控制向量传递给执行器饱和补偿器(10),得到输入饱和条件下的控制量sat(τi),并将其传递给故障检测观测器(11);
6)考虑到船舶执行器故障的不确定性,如果故障检测观测器(11)观测到执行机构(3)正常运行,则将控制信号τ直接传递给动力船舶;若观测到执行器发生故障,则将控制信号传递给执行机构故障补偿器(12),再将产生的补偿量τi传递给动力船舶,最终使船舶运动到期望位姿状态。
设计船舶三自由度低频运动模型为:
式中,R(ψ)为旋转矩阵,其定义为且满足特性R-1(ψ)=RT(ψ)。M为惯量矩阵,是可逆的正定对称阵;D为线性阻尼阵,也是正定矩阵;τ为控制输入向量,d(t)是未知的扰动项,代表风、浪、流等环境因素对船舶产生的综合恒值干扰力和力矩。
位置传感器(5)测量得到船舶位置和艏向矢量式为η=[x,y,ψ]T,速度传感器(6)测量得到速度矢量式为v=[u,v,r]T。传感器将采集到的数据传递给状态观测器(3)。状态观测器形式如下:
sat(τi)=τi(t)+θ(t)
其中τi表示由执行器实际控制转矩;ui表示期望的控制转矩;代表不确定执行器故障。lii=1表示执行器正常稳定运行,0<lii(t)<1表示执行器损失部分有效性,但仍能正常运行。因此,τ可以写成其中,τ=[τ1,τ2,τ3]T表示实际控制,u代表控制器命令的控制输入,表示不确定的故障,L(t)=diag[l11(t),l22(t),l33(t)]描述了执行器的有效性。
式中β(x1)=R(ψ)M-1,Td=R(ψ)M-1ξ(t)。
为了保证有限的时间稳定性,引入以下辅助函数
根据控制器模型,控制律设计为:
u=un(t)+ua(t)
ua(t)=-κsggn(z)||un(t)||
如图2至图5所示,通过对仿真曲线和数据分析后可以看出,本发明所提出的有限时间控制***能够较为准确的控制出船舶运动过程,为动力定位作业提供了方便。从仿真曲线对比可以看出控制***达到了较好的控制效果。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。
Claims (1)
1.带有时滞和饱和的欠驱动船舶有限时间动力定位控制***,包括动力定位船舶、传感器模块、状态观测器和执行机构,动力定位船舶所受合力由海洋干扰和执行机构所提供的推力两部分组成;传感器模块实时采集动力定位船舶的位置和艏向角信息η以及线速度和角速度信息v,并将采集到的信息传递给状态观测器,其特征是,还包括:
时滞补偿器,得到时间间隔测量模块传来的位置和速度信号后,经过时滞补偿器,得到带有时滞项的位置和速度信号,并将其传递给有限时间跟踪控制器;
执行器饱和补偿器,控制信号τ经过有限时间跟踪控制器后得到的控制向量传递给执行器饱和补偿器,得到输入饱和条件下的控制量sat(τi),并将其传递给故障检测观测器;
故障检测观测器,如果故障检测观测器观测到执行机构正常运行,则将控制信号sat(τi)直接传递给动力定位船舶;若观测到执行机构发生故障,则将控制信号sat(τi)传递给执行机构故障补偿器,再将产生的补偿量传递给动力定位船舶,最终使船舶运动到期望位姿状态;
所述动力定位船舶的三自由度低频运动模型为:
式中,R(ψ)为旋转矩阵,其定义为且满足特性R-1(ψ)=RT(ψ),M为惯量矩阵,是可逆的正定对称阵;D为线性阻尼阵,也是正定矩阵;τ为控制输入向量,d(t)是未知的扰动项,代表风、浪、流环境因素对船舶产生的综合恒值干扰力和力矩;
sat(τi)=τi(t)+θ(t)
lii=1表示执行器正常稳定运行,0<lii(t)<1表示执行器损失部分有效性,但仍能正常运行,因此,τ可以写成其中,τ=[τ1,τ2,τ3]T表示实际控制,u代表控制器命令的控制输入,表示不确定的故障,L(t)=diag[l11(t),l22(t),l33(t)]描述了执行器的有效性;
式中β(x1)=R(ψ)M-1,Td=R(ψ)M-1ξ(t);
为了保证有限的时间稳定性,引入以下辅助函数
根据控制器模型,控制律设计为:
u=un(t)+ua(t)
ua(t)=-κsggn(z)||un(t)||;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811450755.6A CN110045726B (zh) | 2018-11-30 | 2018-11-30 | 带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811450755.6A CN110045726B (zh) | 2018-11-30 | 2018-11-30 | 带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110045726A CN110045726A (zh) | 2019-07-23 |
CN110045726B true CN110045726B (zh) | 2022-03-01 |
Family
ID=67273275
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811450755.6A Active CN110045726B (zh) | 2018-11-30 | 2018-11-30 | 带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110045726B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110794843B (zh) * | 2019-11-15 | 2022-11-01 | 山东交通学院 | 基于观测器的非线性船舶时滞动力定位船鲁棒镇定*** |
CN111538242B (zh) * | 2020-05-12 | 2023-01-03 | 哈尔滨工程大学 | 一种不确定性估计和饱和补偿的动力定位t-s模糊抗饱和控制方法 |
CN111538341B (zh) * | 2020-06-02 | 2023-04-14 | 大连海事大学 | 基于宽度学习自适应动态规划的船舶动力定位优化控制方法 |
CN112230550B (zh) * | 2020-10-29 | 2023-10-13 | 哈尔滨工程大学 | 一种欠驱船的轨迹跟踪指定时间收敛控制*** |
CN115402921A (zh) * | 2022-08-30 | 2022-11-29 | 青岛欧亚海洋调查装备有限公司 | 一种具有精准投放功能的脱钩器 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108681246A (zh) * | 2018-05-14 | 2018-10-19 | 大连海事大学 | 一种基于执行器故障的无人水面船航迹跟踪方法 |
CN108828943A (zh) * | 2018-06-20 | 2018-11-16 | 南通航运职业技术学院 | 一种带扰动补偿和有限时间收敛的自抗扰控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8626366B2 (en) * | 2008-12-29 | 2014-01-07 | General Electric Company | System and method for controlling a marine vessel through a waterway |
CN104076690B (zh) * | 2014-07-24 | 2016-09-28 | 江南大学 | 一种非线性船舶动力***的自适应定位跟踪容错控制方法 |
CN108490946A (zh) * | 2018-04-13 | 2018-09-04 | 武汉理工大学 | 一种船舶动力定位控制方法 |
-
2018
- 2018-11-30 CN CN201811450755.6A patent/CN110045726B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108681246A (zh) * | 2018-05-14 | 2018-10-19 | 大连海事大学 | 一种基于执行器故障的无人水面船航迹跟踪方法 |
CN108828943A (zh) * | 2018-06-20 | 2018-11-16 | 南通航运职业技术学院 | 一种带扰动补偿和有限时间收敛的自抗扰控制方法 |
Non-Patent Citations (2)
Title |
---|
Synthesis of controllers for continuous-time delay systems with saturating controls via LMI"s;Sophie Tarbouriech 等;《 IEEE Transactions on Automatic Control》;20000131;第45卷(第1期);第105-111页 * |
带有输入时滞的动力定位船鲁棒滑模控制;谢文博 等;《哈尔滨工程大学学报》;20131031;第34卷(第10期);第1249-1253页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110045726A (zh) | 2019-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110045726B (zh) | 带有时滞和饱和的欠驱动船舶有限时间动力定位控制*** | |
CN110753894B (zh) | 控制船舶 | |
CN107121928B (zh) | 一种无人水面艇的扰动补偿控制方法 | |
CN111158383B (zh) | 基于干扰观测器和rbfnn的无人艇航迹跟踪控制方法 | |
CN103592846B (zh) | 基于自适应模糊估计器的滤波反步船舶运动控制*** | |
CN103116357A (zh) | 一种具有抗干扰容错性能的滑模控制方法 | |
CN113741468B (zh) | 一种分布式无人艇编队的有限时间容错控制方法 | |
CN105629988B (zh) | 一种无拖曳卫星的抗干扰姿态控制方法 | |
CN103676654B (zh) | 基于干扰补偿的船舶动力定位速度估计***及方法 | |
CN110597069A (zh) | 一种基于rbf神经网络的水下机器人自适应区域动力定位控制方法 | |
CN106569487A (zh) | 一种基于观测器的伺服***的故障检测方法 | |
CN110794843B (zh) | 基于观测器的非线性船舶时滞动力定位船鲁棒镇定*** | |
CN109739248B (zh) | 基于adrc的船载三自由度并联稳定平台稳定控制方法 | |
CN106444359A (zh) | 一种喷水推进无人艇自主区域保持的仿人智能控制方法 | |
CN115562005A (zh) | 一种基于复合学习的水面船舶动态事件触发控制方法 | |
CN108469731B (zh) | 一种波浪滑翔器故障监测与鲁棒控制方法 | |
Chen et al. | Adaptive backstepping fast terminal sliding mode control of dynamic positioning ships with uncertainty and unknown disturbances | |
CN109752957B (zh) | 一种无人艇的制导指令调节器结构及设计方法 | |
Hu et al. | Actuator fault detection for automation underwater vehicle via extended state observer and adaptive threshold | |
CN113835340B (zh) | 一种考虑输入量化和非线性死区的水下机器人无模型控制方法 | |
CN115951693A (zh) | 一种欠驱动水下机器人鲁棒轨迹跟踪控制方法 | |
CN115686008A (zh) | 基于指令滤波反步法的船舶动力定位辅助锚泊***设计 | |
CN110837254B (zh) | 一种水翼艇纵向运动控制方法 | |
CN115903807B (zh) | 一种基于动态事件触发的动力定位船轨迹跟踪控制方法 | |
CN113835338B (zh) | 积分滑模的欠驱动无人艇的有限时间跟踪控制方法及装置 |
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 |