CN110515387A - 一种水面船舶漂角补偿非线性航向控制方法 - Google Patents
一种水面船舶漂角补偿非线性航向控制方法 Download PDFInfo
- Publication number
- CN110515387A CN110515387A CN201910908132.7A CN201910908132A CN110515387A CN 110515387 A CN110515387 A CN 110515387A CN 201910908132 A CN201910908132 A CN 201910908132A CN 110515387 A CN110515387 A CN 110515387A
- Authority
- CN
- China
- Prior art keywords
- course
- drift angle
- heading
- control
- heading 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 25
- 238000013461 design Methods 0.000 claims abstract description 12
- 240000007049 Juglans regia Species 0.000 claims abstract description 9
- 230000000694 effects Effects 0.000 claims abstract description 6
- 230000035935 pregnancy Effects 0.000 claims description 7
- 238000011045 prefiltration Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000013016 damping Methods 0.000 claims description 3
- 230000003044 adaptive effect Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 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
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:基于Nussbaum增益方法和自适应控制方法设计航向控制规律;步骤5:判断航向控制效果是否满意,如果“是”则结束控制,如果“否”则更新状态返回步骤3重新计算航向控制信号。
Description
技术领域
本发明涉及船舶运动控制领域,特别是涉及一种水面船舶漂角补偿非线性航向控制方法。
技术背景
船舶在海上航行不可避免产生六自由度摇摆运动,艏摇运动决定船舶航向保持精度,航向是船舶导航和控制工程中的重要问题。为保证舰船顺利抵达目的地,以自动舵为执行机构的航向控制***是水面常规舰船所必须安装的。水面船舶的航向控制包括航向保持控制和转向控制,水平面坐标系下的船舶艏摇运动如图1所示。船舶操舵运动首先使船艏产生一个小的横向漂角β(通常小于5°)改变船体两侧流体分布状态,进而由船体两侧的水动力作用实现船体的转向运动。目前的船舶航向控制算法基本是忽略此漂角作用,采用航向偏差为ψe=ψ-ψd的形式,但是该漂角的存在会增加航向超调降低航向控制精度,因此需要进行补偿。另一方面,目前应用最多的航向控制模型为一阶线性Nomoto模型,该模型适合航向保持控制,但是对于转向控制需要考虑高阶非线性条件。同时,船体受海浪的时变扰动作用,必然存在模型动态不确定(未建模动态)和参数时变等问题,这些问题均需要非线性控制方法去解决。
发明内容
本发明主要解决的技术问题是:克服现有技术的不足,提出一种水面船舶漂角补偿非线性航向控制方法,解决船舶航向控制中的漂角补偿,模型动态不确定和参数时变问题。
本发明的技术提供的解决方案是:一种水面船舶漂角补偿非线性航向控制方法,具体步骤包括:
步骤1:基于一阶漂角模型和二阶非线性Nomoto模型,建立漂角补偿的水面船舶航向控制状态空间非线性模型;
步骤1中的水面船舶航向控制状态空间非线性模型由如下公式表示:
其中:***状态定义为,x1=ψ表示航向角,x2=β代表漂角,代表航向角速度,代表航向角加速度。Δβ为漂角模型不确定,f(x)为***未建模动态(动态不确定),w为外部时变扰动,g(t)为时变控制系数,u为***控制信号,c1和c2为正常数的漂角模型参数标称值。
步骤2:利用指令航向角ψr通过前置滤波器获取光滑的指令航向角ψd及其导数
步骤2中的前置滤波器采用如下公式计算:
其中:ξ为滤波器阻尼,ω是滤波器频率,ψr是目标航向角。
步骤3:根据步骤1和步骤2采集指令航向角ψd,航向角ψ和漂角β信号并获取航向角误差信号ψe(t)=ψ-ψd+β;
步骤4:基于Nussbaum增益方法和自适应控制方法设计航向控制规律,航向控制信号u(t)通过舵机伺服***驱动转舵最终实现航向控制;
步骤4中的航向控制信号由如下公式表示:
其中:N(ζ)为Nussbaum函数,z2=x3-α1和z3=x4-α2为虚拟误差信号,k3为设计的正常数,为***未建模动态(动态不确定)的估计,为外部时变扰动上界的估计,为虚拟控制信号α2的导数。
控制规律虚拟控制信号α1和α2分别由如下公式计算:
其中:k1和k2为设计的正常数,z1=ψe=x1-ψd+x2为航向误差信号,为漂角模型不确定的估计。
步骤5:判断航向控制效果是否满意,如果“是”则结束控制,如果“否”则更新状态返回步骤3重新计算航向控制信号。
本发明的有益效果是:通过建立漂角修正非线性航向模型和基于Nussbaum增益的自适应控制方法实现漂角补偿的航向控制,有效减小航向跟踪稳态误差和航向保持控制下的操舵指令信号,同时本发明无需模型中非线性部分的具体建模信息和时变参数的先验信息,可以提高恶劣海况下水面船舶航向控制的鲁棒性。
附图说明
图1是水面船舶艏摇运动坐标系示意图;
图2是本发明中航向控制***结构图;
图3是本发明提供的一种水面船舶漂角补偿非线性航向控制方法流程图。
具体实施方式
下面结合附图对本发明的较佳实施例进行详细阐述,以使本发明的优点和特征能更易于被本领域技术人员理解。
如图2为本发明中航向控制***结构图、图3是本发明提供的一种水面船舶漂角补偿非线性航向控制方法流程图,本发明公开的一种水面船舶漂角补偿非线性航向控制方法具体实现如下:
步骤1:基于一阶漂角模型和二阶非线性Nomoto模型,建立漂角补偿的水面船舶航向控制状态空间非线性模型;
二阶非线性Nomoto模型为如下公式(1)形式:
其中:ψ为航向角,δ为舵角,a1,a2,a3,b1和b2为模型参数,模型参数的具体数值可根据所选择的具体船舶来确定或估算。
一阶漂角模型为如下公式(2)形式:
其中:为有界的模型不确定(即|Δβ|≤Δβmax且Δβmax是未知正常数),c1和c2是模型标称值且满足0<c1<1,0<c2<1,具体数值可根据船模实验或者***辨识的方法加以估算。
根据公式(1)和公式(2),基于漂角补偿的水面船舶航向控制状态空间非线性模型由如下公式(3)表示:
其中:***状态定义为,x1=ψ表示航向角,x2=β代表漂角,代表航向角速度,代表航向角加速度。为***未建模动态(动态不确定),w为外部时变扰动,g(t)=b1为时变控制系数。为***控制信号,即输入到舵机伺服***的控制信号并输出舵角。
步骤2:利用指令航向角ψr通过前置滤波器获取光滑的指令航向角ψd及其导数
前置滤波器采用如下公式(4)计算:
其中:ξ为滤波器阻尼,ω是滤波器频率,ψr是目标航向角。
步骤3:根据步骤1和步骤2采集指令航向角ψd,航向角ψ和漂角β信号并获取航向角误差信号ψe(t)=ψ-ψd+β;
步骤4:基于Nussbaum增益方法和自适应控制方法设计航向控制规律,航向控制信号u(t)通过舵机伺服***驱动转舵最终实现航向控制;
航向控制信号由如下公式表示:
其中:N(ζ)为Nussbaum函数可根据需要自行选取,见参考文献“Ye,X.,Jiang,J.Adaptive nonlinear design without a priori knowledge of controldirections.IEEE Transactions on Automatic Control,1998,43(11):1617-1621.”,z2=3x-1α和z3=x4-α2为虚拟误差信号,k3为设计的正常数,为***未建模动态(动态不确定)的估计,为外部时变扰动上界的估计,为虚拟控制信号α2的导数。
航向控制规律(5)和(6)中的虚拟控制信号α1和α2分别由如下公式计算:
其中:k1和k2为设计的正常数,z1=ψe=x1-ψd+x2为航向误差信号,为漂角模型不确定的估计。
漂角模型不确定的估计***未建模动态的估计和外部时变扰动上界的估计可根据需要采用合适的自适应方法计算,或采用如下自适应规律计算:
其中:aβ,σβ,af,σf,aw和σw为设计的正常数,为外部时变扰动上界估计的初值。
步骤5:判断航向控制效果是否满意,如果“是”则结束控制,如果“否”则更新状态返回步骤3重新计算航向控制信号。
本发明的有益效果是:通过建立漂角修正非线性航向模型和基于Nussbaum增益的自适应控制方法实现漂角补偿的航向控制,有效减小航向跟踪稳态误差和航向保持控制下的操舵指令信号,同时本发明无需模型中非线性部分的具体建模信息和时变参数的先验信息,可以提高恶劣海况下水面船舶航向控制的鲁棒性。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (4)
1.一种水面船舶漂角补偿非线性航向控制方法,其特征在于包括以下步骤:
步骤1:基于一阶漂角模型和二阶非线性Nomoto模型,建立漂角补偿的水面船舶航向控制状态空间非线性模型;
步骤2:利用指令航向角ψr通过前置滤波器获取光滑的指令航向角ψd及其导数
步骤3:根据步骤1和步骤2采集指令航向角ψd,航向角ψ和漂角β信号并获取航向角误差信号ψe(t)=ψ-ψd+β;
步骤4:基于Nussbaum增益方法和自适应控制方法设计航向控制规律,航向控制信号u(t)通过舵机伺服***驱动转舵最终实现航向控制;
步骤5:判断航向控制效果是否满意,如果“是”则结束控制,如果“否”则更新状态返回步骤3重新计算航向控制信号。
2.根据权利要求1所述的一种水面船舶漂角补偿非线性航向控制方法,其特征在于:步骤1中的水面船舶航向控制状态空间非线性模型由如下公式表示:
其中:***状态定义为,x1=ψ表示航向角,x2=β代表漂角,代表航向角速度,代表航向角加速度。Δβ为漂角模型不确定,f(x)为***未建模动态(动态不确定),w为外部时变扰动,g(t)为时变控制系数,u为***控制信号,c1和c2为正常数的漂角模型参数标称值。
3.根据权利要求1所述的一种水面船舶漂角补偿非线性航向控制方法,其特征在于:步骤2中的前置滤波器采用如下公式计算:
其中:ξ为滤波器阻尼,ω是滤波器频率,ψr是目标航向角。
4.根据权利要求1所述的一种水面船舶漂角补偿非线性航向控制方法,其特征在于:步骤4中的航向控制信号由如下公式表示:
其中:N(ζ)为Nussbaum函数,z2=x3-α1和z3=x4-α2为虚拟误差信号,k3为设计的正常数,为***未建模动态(动态不确定)的估计,为外部时变扰动上界的估计,为虚拟控制信号α2的导数。
控制规律虚拟控制信号α1和α2分别由如下公式计算:
其中:k1和k2为设计的正常数,z1=ψe=x1-ψd+x2,为漂角模型不确定的估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910908132.7A CN110515387A (zh) | 2019-09-25 | 2019-09-25 | 一种水面船舶漂角补偿非线性航向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910908132.7A CN110515387A (zh) | 2019-09-25 | 2019-09-25 | 一种水面船舶漂角补偿非线性航向控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110515387A true CN110515387A (zh) | 2019-11-29 |
Family
ID=68633598
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910908132.7A Withdrawn CN110515387A (zh) | 2019-09-25 | 2019-09-25 | 一种水面船舶漂角补偿非线性航向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110515387A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112230666A (zh) * | 2020-10-30 | 2021-01-15 | 上海海事大学 | 一种基于自适应扩展状态观测器的漂角修正航向控制方法 |
CN112685974A (zh) * | 2020-12-31 | 2021-04-20 | 哈尔滨工程大学 | 一种基于cfd的船舶参数辨识方法 |
CN113296517A (zh) * | 2021-05-25 | 2021-08-24 | 上海海事大学 | 一种基于漂角补偿的船舶航向动态面滑模控制方法 |
-
2019
- 2019-09-25 CN CN201910908132.7A patent/CN110515387A/zh not_active Withdrawn
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112230666A (zh) * | 2020-10-30 | 2021-01-15 | 上海海事大学 | 一种基于自适应扩展状态观测器的漂角修正航向控制方法 |
CN112230666B (zh) * | 2020-10-30 | 2024-06-07 | 上海海事大学 | 一种基于自适应扩展状态观测器的漂角修正航向控制方法 |
CN112685974A (zh) * | 2020-12-31 | 2021-04-20 | 哈尔滨工程大学 | 一种基于cfd的船舶参数辨识方法 |
CN113296517A (zh) * | 2021-05-25 | 2021-08-24 | 上海海事大学 | 一种基于漂角补偿的船舶航向动态面滑模控制方法 |
CN113296517B (zh) * | 2021-05-25 | 2023-03-24 | 上海海事大学 | 一种基于漂角补偿的船舶航向动态面滑模控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108445892B (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
CN108052009B (zh) | 基于滤波反步法的水面目标救援跟踪观测控制器设计方法 | |
CN108008628B (zh) | 一种不确定欠驱动无人艇***的预设性能控制方法 | |
Fossen et al. | Nonlinear output feedback control of dynamically positioned ships using vectorial observer backstepping | |
Sawada et al. | Path following algorithm application to automatic berthing control | |
CN108319140B (zh) | 一种重定义输出式无模型自适应航向控制方法及*** | |
CN110515387A (zh) | 一种水面船舶漂角补偿非线性航向控制方法 | |
CN110333658B (zh) | 一种带输入约束和漂角补偿的欠驱动船舶航向控制方法 | |
CN108415423A (zh) | 一种高抗扰自适应路径跟随方法及*** | |
CN110244556B (zh) | 基于期望航向修正的欠驱动船舶航向控制方法 | |
CN110134012A (zh) | 一种用于不确定***的船舶路径跟踪控制方法 | |
CN111798702B (zh) | 无人艇路径跟踪控制方法、***、存储介质及终端 | |
CN111198502A (zh) | 基于干扰观测器和模糊***的无人艇航迹跟踪控制方法 | |
CN115167481A (zh) | 一种欠驱动无人艇预设性能路径跟踪控制方法及*** | |
CN115113524B (zh) | 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法 | |
CN113608534A (zh) | 一种无人艇跟踪控制方法及*** | |
CN115963841A (zh) | 基于改进lvs制导的无人帆船动态事件触发控制方法 | |
CN112363393A (zh) | 无人艇动力定位的无模型自适应预设性能控制方法 | |
CN111427356A (zh) | 一种船舶航向区间控制方法和*** | |
CN113093735A (zh) | 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、***及介质 | |
CN113741433A (zh) | 一种水面无人船的分布式编队方法 | |
CN111506090A (zh) | 一种水下机器人深度区间控制方法和*** | |
Rodriguez et al. | Adaptive takeoff maneuver optimization of a sailing boat for America’s cup | |
CN110716572A (zh) | 基于pch模型的多艘动力定位船鲁棒同时镇定*** | |
CN116088309A (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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20191129 |
|
WW01 | Invention patent application withdrawn after publication |