CN111427356A - 一种船舶航向区间控制方法和系统 - Google Patents
一种船舶航向区间控制方法和系统 Download PDFInfo
- Publication number
- CN111427356A CN111427356A CN202010287977.1A CN202010287977A CN111427356A CN 111427356 A CN111427356 A CN 111427356A CN 202010287977 A CN202010287977 A CN 202010287977A CN 111427356 A CN111427356 A CN 111427356A
- Authority
- CN
- China
- Prior art keywords
- matrix
- course
- rudder
- rudder angle
- ship
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims abstract description 121
- 230000003416 augmentation Effects 0.000 claims description 11
- 230000008569 process Effects 0.000 abstract description 5
- 238000005299 abrasion Methods 0.000 abstract description 4
- 238000005265 energy consumption Methods 0.000 abstract description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 3
- 230000002349 favourable effect Effects 0.000 abstract 1
- 238000002474 experimental method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification 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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种舵角舵速约束下的水面船舶航向区间控制方法和系统,属于船舶运动控制领域。本发明的方法包括:计算多步预测状态矩阵;计算多步输入矩阵;更新反馈校正矩阵并计算多步预测航向;根据当前方向舵角度计算舵角舵速约束下的舵角增量输出向量;取舵角增量输出向量的第一行作为当前时刻舵角增量输出。本发明适用于舵角舵速约束下的水面船舶航向区间控制,有利于减少船舶舵机机械结构的磨损,减少船舶航行过程中的能耗。
Description
技术领域
本发明属于船舶运动控制领域,更具体地,涉及一种船舶航向区间控制方法和系统。
背景技术
船舶航向控制对于现代船舶航行具有非常重要的意义,现代船舶的航向控制功能通常通过自动舵或具有类似功能的航向控制器实现。通过预设路径点和导航算法,船舶可以自动地航行至目的地港口,大大提高船舶航行的稳定性,减轻船员的工作负担。
导航算法给出的参考航向多是一个固定航向,现有技术也多是针对航向定值控制这一问题,船舶在海洋中航行的过程中易受到风浪流等外界干扰,如果说采用航向定值控制,将航向保持在一个固定值,则需要在航行过程中针对外界干扰频繁打舵修正航向。船舶本身具有较大的质量,因此拥有很大的惯性,依靠打舵修正航向只能解决由外界干扰中低频部分造成的航向偏移,而针对外界干扰中的高频部分进行打舵修正效果有限且会加速舵机的磨损,增加船舶的功耗。
不同于定值控制,区间控制的目的是将被控对象控制在一个给定的区间内而不是控制在一个给定的值。对于航行在海洋中的船舶来说,若将船舶的航向控制在一个给定的区间内,就能够一定程度上忽视外界干扰中的高频部分对航向控制的影响,并依靠导航算法依然可以使得船舶保持在给定的航线上从而顺利到达目的地。因此,亟需一种水面船舶的航向区间控制方法以减少打舵的频率和幅度。
发明内容
针对现有技术的缺陷,本发明的目的在于提供一种船舶航向区间控制方法和系统,旨在减少船舶舵机机械结构的磨损,并降低船舶航行过程中的能耗。
为实现上述目的,本发明一方面提供了一种船舶航向区间控制方法,包括以下步骤:
根据航向控制增广状态空间方程中的状态预测矩阵A计算多步预测状态矩阵P,根据输入矩阵B计算多步输入矩阵H;
构建包含优化参考轨迹α、舵角增量输出向量Δδr和所述多步预测状态变量的代价函数,结合舵角约束条件、舵速约束条件和区间约束条件,求解约束条件下的二次规划,从而获得舵角舵速约束下的舵角增量输出向量Δδr。
进一步地,所述船舶航向控制增广状态空间方程为
进一步地,所述多步预测状态矩阵
所述多步输入矩阵
其中ny是预测步长,C为一个常值矩阵且C=[0 0 1 0],所述多步输入矩阵H的列数为控制步长nu。
进一步地,所述更新反馈校正矩阵D包括:
进一步地,所述代价函数
进一步地,所述舵速约束条件为
进一步地,所述舵角约束条件为
进一步地,所述区间约束条件为
本发明的另一方面还提供了一种船舶航向区间控制系统,包括
多步预测状态矩阵获取模块,用于根据航向控制增广状态空间方程中的状态预测矩阵A获取多步预测状态矩阵P;
多步输入矩阵获取模块,用于根据航向控制增广状态空间方程中的输入矩阵B获取多步输入矩阵H;
二次规划模块,构建包含优化参考轨迹α、舵角增量输出向量Δδr和所述多步预测状态变量的代价函数,结合舵角约束条件、舵速约束条件和区间约束条件,求解约束条件下的二次规划,从而获得舵角舵速约束下的舵角增量输出向量Δδr。
通过本发明所构思的以上技术方案,与现有技术相比,能够取得下列有益效果:
(1)本发明提供的航向区间控制方法和系统将船舶的航向控制在一个给定的区间内,能够一定程度上忽视外界干扰中的高频部分对航向控制的影响,使得船舶在风浪流干扰中航行时保持在给定区间内并有效减少打舵次数,降低舵机等机械结构的磨损和船舶的能耗。
(2)本发明提供的航向区间控制方法和系统中,在设计控制器的时候考虑了舵角和舵速的约束情况,提高了航向控制的稳定性。
附图说明
图1是本发明实施例的算法流程示意图;
图2是本发明实施例的半物理实验曲线图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明实施例提供了一种舵角舵速约束下的水面船舶航向区间控制方法,包括以下步骤:
S1.根据状态预测矩阵A计算多步预测状态矩阵P;
S2.根据输入矩阵B计算多步输入矩阵H;
S4.更新反馈校正矩阵D并根据当前时刻估算的状态变量计算多步预测状态变量;
S6.取舵角增量输出向量Δδr的第一行作为当前时刻舵角增量输出,等待当前控制周期结束,返回步骤S3。
下面对具体操作进行详细阐述:
所述步骤S1具体包括:
所述步骤S2具体包括:
所述步骤S3具体包括:
所述步骤S4具体包括:
所述步骤S5具体包括:
S5.1构建代价函数 代表二范数,权重矩阵为Q。代表二范数,权重矩阵为R。矩阵P为步骤S1中的多步预测状态矩阵,矩阵H为步骤S2中多步输入矩阵,D为步骤S4中反馈校正矩阵。维数匹配矩阵M的作用是使得矩阵M和优化参考轨迹α的乘积的维度和预测步长匹配。
S5.2将S5.1中的代价函数J展开可得到
J=(Mα)TQ(Mα)-(Mα)TQ(Pz)-(Mαt)TQ(HΔδr)-(Mα)TQD-(Pz)TQ(Mα)+(Pz)TQ(Pz)+(Pz)TQ(HΔδr)+(Pz)TQD-(HΔδr)TQ(Mα)+(HΔδr)TQ(Pz)+(HΔδr)TQ(HΔδr)+(HΔδr)TQD-DTQ(Mα)+DTQ(Pz)+DTQ(HΔδr)+DTQD+Δδr TRΔδr
S5.4受机械结构和物理能量输出的约束,船舶的舵角不是无限大,转舵的速度也有上限,因此在设计控制器的时候需要考虑舵角和舵速的约束情况,否则设计出来的控制器可能会导致航向控制的不稳定。
S5.5结合S5.3中的代价函数J1和S5.4中的矩阵不等式约束,舵角舵速约束下的航向区间控制问题至此变成一个带约束的二次规划问题:
所述步骤S6具体包括:
相对应地,本发明实施例还提供了一种船舶航向区间控制系统,包括
多步预测状态矩阵获取模块,用于根据航向控制增广状态空间方程中的状态预测矩阵A获取多步预测状态矩阵P;
多步输入矩阵获取模块,用于根据航向控制增广状态空间方程中的输入矩阵B获取多步输入矩阵H;
二次规划模块,构建包含优化参考轨迹α、舵角增量输出向量Δδr和所述多步预测状态变量的代价函数,结合舵角约束条件、舵速约束条件和区间约束条件,求解约束条件下的二次规划,从而获得舵角舵速约束下的舵角增量输出向量Δ6r。
图2是本发明实施例的半物理实验曲线图。由图2可以看出,船舶从初始航向30°变向至60°过程中,最大和最小舵角值始终处于舵角约束范围内,动舵过程中舵速也被控制在给定的舵速约束范围内。待船舶到达60°航向区间范围内以后,航向始终在给定区间的范围内变化,而舵角在整个过程仅动舵4次。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
10.一种船舶航向区间控制系统,其特征在于,包括
多步预测状态矩阵获取模块,用于根据航向控制增广状态空间方程中的状态预测矩阵A获取多步预测状态矩阵P;
多步输入矩阵获取模块,用于根据航向控制增广状态空间方程中的输入矩阵B获取多步输入矩阵H;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010287977.1A CN111427356A (zh) | 2020-04-13 | 2020-04-13 | 一种船舶航向区间控制方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010287977.1A CN111427356A (zh) | 2020-04-13 | 2020-04-13 | 一种船舶航向区间控制方法和系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111427356A true CN111427356A (zh) | 2020-07-17 |
Family
ID=71557780
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010287977.1A Pending CN111427356A (zh) | 2020-04-13 | 2020-04-13 | 一种船舶航向区间控制方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111427356A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111506090A (zh) * | 2020-04-18 | 2020-08-07 | 华中科技大学 | 一种水下机器人深度区间控制方法和系统 |
CN112085969A (zh) * | 2020-09-04 | 2020-12-15 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种本船安全航向区间的确定方法及相关系统 |
CN112256026A (zh) * | 2020-10-14 | 2021-01-22 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种多约束条件下的船舶航向模型预测控制算法设计方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010118752A1 (en) * | 2009-04-14 | 2010-10-21 | Danmarks Tekniske Universitet | Prediction of resonant oscillation |
CN105867165A (zh) * | 2016-04-01 | 2016-08-17 | 哈尔滨工程大学 | 基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统 |
CN105984350A (zh) * | 2015-03-23 | 2016-10-05 | 现代自动车株式会社 | 用于混合动力电动车辆的制动控制方法 |
CN107589748A (zh) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | 基于UnscentedFastSLAM算法的AUV自主导航方法 |
CN111506090A (zh) * | 2020-04-18 | 2020-08-07 | 华中科技大学 | 一种水下机器人深度区间控制方法和系统 |
-
2020
- 2020-04-13 CN CN202010287977.1A patent/CN111427356A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2010118752A1 (en) * | 2009-04-14 | 2010-10-21 | Danmarks Tekniske Universitet | Prediction of resonant oscillation |
CN105984350A (zh) * | 2015-03-23 | 2016-10-05 | 现代自动车株式会社 | 用于混合动力电动车辆的制动控制方法 |
CN105867165A (zh) * | 2016-04-01 | 2016-08-17 | 哈尔滨工程大学 | 基于扩展卡尔曼滤波器的动力定位船舶波频模型参数估计系统 |
CN107589748A (zh) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | 基于UnscentedFastSLAM算法的AUV自主导航方法 |
CN111506090A (zh) * | 2020-04-18 | 2020-08-07 | 华中科技大学 | 一种水下机器人深度区间控制方法和系统 |
Non-Patent Citations (1)
Title |
---|
XUDONG WANG, TAO GENG: "A zone control method for ship heading under wave disturbance", 《ICIRA 2018:INTELLIGENT ROBOTICS AND APPLICATIONS》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111506090A (zh) * | 2020-04-18 | 2020-08-07 | 华中科技大学 | 一种水下机器人深度区间控制方法和系统 |
CN112085969A (zh) * | 2020-09-04 | 2020-12-15 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种本船安全航向区间的确定方法及相关系统 |
CN112256026A (zh) * | 2020-10-14 | 2021-01-22 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种多约束条件下的船舶航向模型预测控制算法设计方法 |
CN112256026B (zh) * | 2020-10-14 | 2022-11-29 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种多约束条件下的船舶航向模型预测控制算法设计方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111427356A (zh) | 一种船舶航向区间控制方法和系统 | |
CN108008628B (zh) | 一种不确定欠驱动无人艇系统的预设性能控制方法 | |
Li et al. | Path following for marine surface vessels with rudder and roll constraints: An MPC approach | |
Fossen et al. | Kalman filtering for positioning and heading control of ships and offshore rigs | |
CN110618686B (zh) | 一种基于显式模型预测控制的无人船航迹控制方法 | |
CN113885534B (zh) | 一种基于智能预测控制的水面无人船路径跟踪方法 | |
CN108319140B (zh) | 一种重定义输出式无模型自适应航向控制方法及系统 | |
Zhang et al. | Improved concise backstepping control of course keeping for ships using nonlinear feedback technique | |
Yan et al. | Course-keeping control for ships with nonlinear feedback and zero-order holder component | |
CN114815626B (zh) | 一种舵鳍系统的预测自抗扰减摇控制方法 | |
CN113341953A (zh) | 一种吊舱式无人艇航向控制方法 | |
Zhang et al. | Improved integral LOS guidance and path-following control for an unmanned robot sailboat via the robust neural damping technique | |
CN117707162A (zh) | 基于改进lvs制导的无人帆船动态事件触发控制方法 | |
Li et al. | Soft-switching proximate time optimal heading control for underactuated autonomous underwater vehicle | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及系统 | |
CN115951581A (zh) | 一种基于改进empc的高速无人艇路径跟踪控制方法 | |
CN110515387A (zh) | 一种水面船舶漂角补偿非线性航向控制方法 | |
Tang et al. | Robust fixed-time trajectory tracking control of the dynamic positioning ship with actuator saturation | |
CN112256026B (zh) | 一种多约束条件下的船舶航向模型预测控制算法设计方法 | |
CN114115276A (zh) | 一种基于在线分组优化模型预测的船舶动力定位控制方法 | |
Yu et al. | Adaptive path following control for wave gliders in ocean currents and waves | |
Saoud et al. | Modeling and control design of a robotic sailboat | |
Liu | Pre-filtered backstepping control for underactuated ship path following | |
CN113741433A (zh) | 一种水面无人船的分布式编队方法 | |
CN111506090A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200717 |
|
RJ01 | Rejection of invention patent application after publication |