CN110308726B - 基于非线性反步法的欠驱动船舶航向控制方法 - Google Patents
基于非线性反步法的欠驱动船舶航向控制方法 Download PDFInfo
- Publication number
- CN110308726B CN110308726B CN201910625738.XA CN201910625738A CN110308726B CN 110308726 B CN110308726 B CN 110308726B CN 201910625738 A CN201910625738 A CN 201910625738A CN 110308726 B CN110308726 B CN 110308726B
- Authority
- CN
- China
- Prior art keywords
- constant
- function
- control
- alpha
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 238000009795 derivation Methods 0.000 claims abstract description 11
- 240000007049 Juglans regia Species 0.000 claims abstract description 7
- 230000033001 locomotion Effects 0.000 claims description 12
- 238000013016 damping Methods 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 230000006978 adaptation Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 230000006641 stabilisation Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 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
本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为反步法设计中所需的可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助***的解决办法,所提出基于反步法的控制方法可以使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,有效减少航向误差,改善控制性能。
Description
技术领域
涉及船舶航向控制领域,具体涉及一种基于非线性反步法的欠驱动船舶航向控制方法。
背景技术
随着对海洋资源的开发利用,船舶控制领域也成为研究热点。大多传统船舶通常是欠驱动的,即只在横荡和艏摇方向上运动,如何更准确的对欠驱动船舶进行航向控制,引起众多国内外学者的关注。输入饱和是实际控制***中的一种常见现象,如果执行器的输入达到一定的极限,就会进入饱和状态导致***性能降低,甚至导致闭环***的不稳定,也会增加舵的损耗。反步法将额外产生的非线性引入控制过程,以消除***中不希望出现的非线性,具有完备的自适应和鲁棒控制理论,在船舶控制领域中有着广泛的应用。但是基于反步法进行航向控制设计是在保证虚拟控制律中所有函数均可导的前提下进行的,如何解决饱和约束的非线性及如何避免虚拟控制律求导时的复杂运算,这些都是使用反步法进行设计时需要解决的难题。
发明内容
本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为反步法设计中所需的可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助***的解决办法,所提出基于反步法的控制方法可以使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,有效减少航向误差,改善控制性能。
主要包括以下步骤:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶***惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi,i=1,2为艏摇和横荡方向上有未知界的外部干扰,是控制***中唯一的控制输入量,是饱和执行器的输出,如下:
其中τ-<0,τ+>0分别代表约束的下限和上限。
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
则式(1)可以改写如下:
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助***来简化求导过程;
其中aijm是aij,i=1,2,j=0,1的界。
步骤4、下达期望航向指令,即设定期望航向角ψd;
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα1 (12)
其中zi,i=1,2,3为辅助变量,αi0,i=1,2表示虚拟镇定函数,具体如下
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助***,即
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助***,即
其中常数γσ>0,γf>0;
其中常数γη>0,设计辅助信号φ为
其中常数k3>0。
步骤6、***更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。
本方法具有如下效果和优点:
通过引入双曲正切函数和Nussbaum函数对控制输入饱和约束进行逼近,成功将非线性函数转化为反步法设计中所需的可导连续函数,设计的自适应律可以实现对逼近误差和外部扰动有效的估计处理,结合反步控制算法的辅助***滤波器解决了虚拟控制律复杂求导的难题。该航向控制算法可以在较短的时间内使***达到稳定,使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,提高了船舶航向控制性能。
附图说明
图1为本发明设计的滤波器结构框图
具体实施方式
本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助***的解决办法,基于反步法构成完整控制***。包括以下步骤:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶***惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi(i=1,2)为艏摇和横荡方向上有未知界的外部干扰,是控制***中唯一的控制输入量,是饱和执行器的输出,如下:
其中τ-<0,τ+>0分别代表约束的下限和上限。
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
则式(1)可以改写如下:
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助***来简化求导过程;
其中aijm是aij,i=1,2,j=0,1的界。
步骤4、下达期望航向指令,即设定期望航向角ψd;
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα 1 (12)
其中zi(i=1,2,3)为辅助变量,αi0(i=1,2)表示虚拟镇定函数,具体如下
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助***,即
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助***,即
其中常数γσ>0,γf>0;
其中常数γη>0,设计辅助信号φ为
其中常数k3>0。
步骤6、***更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。
Claims (1)
1.一种基于非线性反步法的欠驱动船舶航向控制方法,其特征在于:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶***惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi,i=1,2为艏摇和横荡方向上有未知界的外部干扰,是控制***中唯一的控制输入量,是饱和执行器的输出,如下:
其中τ-<0,τ+>0分别代表约束的下限和上限;
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
则式(1)可以改写如下:
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助***来简化求导过程;
其中aijm是aij,i=1,2,j=0,1的界;
步骤4、下达期望航向指令,即设定期望航向角ψd;
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα1 (12)
其中zi,i=1,2,3为辅助变量,αi0,i=1,2表示虚拟镇定函数,具体如下
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助***,即
则α20可选择为
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助***,即
其中常数γσ>0,γf>0;
其中常数γη>0,设计辅助信号φ为
其中常数k3>0;
步骤6、***更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910625738.XA CN110308726B (zh) | 2019-07-11 | 2019-07-11 | 基于非线性反步法的欠驱动船舶航向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910625738.XA CN110308726B (zh) | 2019-07-11 | 2019-07-11 | 基于非线性反步法的欠驱动船舶航向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110308726A CN110308726A (zh) | 2019-10-08 |
CN110308726B true CN110308726B (zh) | 2022-05-13 |
Family
ID=68079866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910625738.XA Active CN110308726B (zh) | 2019-07-11 | 2019-07-11 | 基于非线性反步法的欠驱动船舶航向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110308726B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112987753B (zh) * | 2020-08-26 | 2023-08-01 | 智慧航海(青岛)科技有限公司 | 基于误差船舶航向的控制方法及装置 |
CN112346464A (zh) * | 2020-11-27 | 2021-02-09 | 哈尔滨工程大学 | 结合反步法和自适应模糊方法的欠驱动水面船控制方法 |
CN113110511B (zh) * | 2021-05-19 | 2024-04-05 | 大连海事大学 | 一种基于广义模糊双曲模型的智能船舶航向控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104076821A (zh) * | 2014-06-19 | 2014-10-01 | 哈尔滨工程大学 | 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制*** |
CN108319138A (zh) * | 2018-01-29 | 2018-07-24 | 哈尔滨工程大学 | 一种欠驱动无人艇的滑模-反步双回路轨迹跟踪控制方法 |
CN108803612A (zh) * | 2018-06-27 | 2018-11-13 | 青岛黄海学院 | 一种海流影响下的无人巡检船直线航迹跟踪实现方法 |
CN108829099A (zh) * | 2018-06-01 | 2018-11-16 | 北京航空航天大学 | 一种基于受限反步法控制的欠驱动无人船轨迹跟踪方法 |
-
2019
- 2019-07-11 CN CN201910625738.XA patent/CN110308726B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104076821A (zh) * | 2014-06-19 | 2014-10-01 | 哈尔滨工程大学 | 基于模糊自适应观测器的欠驱动水面艇轨迹跟踪控制*** |
CN108319138A (zh) * | 2018-01-29 | 2018-07-24 | 哈尔滨工程大学 | 一种欠驱动无人艇的滑模-反步双回路轨迹跟踪控制方法 |
CN108829099A (zh) * | 2018-06-01 | 2018-11-16 | 北京航空航天大学 | 一种基于受限反步法控制的欠驱动无人船轨迹跟踪方法 |
CN108803612A (zh) * | 2018-06-27 | 2018-11-13 | 青岛黄海学院 | 一种海流影响下的无人巡检船直线航迹跟踪实现方法 |
Non-Patent Citations (6)
Title |
---|
ADAPTIVE SLIDING MODE CONTROL FOR SHIP AUTOPILOT WITH SPEED KEEPING;Liu, Zhiquan;《POLISH MARITIME RESEARCH》;20181231;21-29 * |
Robust composite nonlinear feedback path-following control for underactuated surface vessels;HU Chuan等;《IEEE Transactions on Industrial Electronics》;20161231;6386-6394 * |
基于DSC和MLP的欠驱动船舶自适应滑模轨迹跟踪控制;沈智鹏等;《***工程与电子技术》;20171227(第03期);全文 * |
存在饱和输入的欠驱动船舶航迹跟踪控制;黄汉涛等;《船舶工程》;20180525(第05期);全文 * |
时变干扰下欠驱动AUV水平面轨迹跟踪的反步滑模控制;严浙平等;《宇航总体技术》;20171115(第04期);全文 * |
欠驱动无人艇直线航迹跟踪的反步自适应动态滑模控制;廖煜雷等;《高技术通讯》;20130615(第06期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110308726A (zh) | 2019-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110308726B (zh) | 基于非线性反步法的欠驱动船舶航向控制方法 | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
CN106774273B (zh) | 针对变时滞控制***执行器故障的滑模预测容错控制方法 | |
CN110673611B (zh) | 一种基于事件触发方案和t-s模糊***的欠驱动无人艇控制方法 | |
CN107544256B (zh) | 基于自适应反步法的水下机器人滑模控制方法 | |
CN108319140B (zh) | 一种重定义输出式无模型自适应航向控制方法及*** | |
CN109839934A (zh) | 基于rise技术的无人水面艇预设性能跟踪控制方法 | |
CN110244556B (zh) | 基于期望航向修正的欠驱动船舶航向控制方法 | |
CN110018637B (zh) | 一种考虑完成时间约束的航天器姿态跟踪保性能控制方法 | |
CN108170151B (zh) | 一种水下机器人的自适应运动控制装置及其方法 | |
CN110244561B (zh) | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 | |
CN109298636B (zh) | 一种改进的积分滑模控制方法 | |
Hu et al. | Sliding mode control unified with the uncertainty and disturbance estimator for dynamically positioned vessels subjected to uncertainties and unknown disturbances | |
CN115113524B (zh) | 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法 | |
CN110262494A (zh) | 一种同构多无人艇***的协同学习与编队控制方法 | |
Liu et al. | Adaptive command filtered backstepping tracking control for AUVs considering model uncertainties and input saturation | |
CN113110511B (zh) | 一种基于广义模糊双曲模型的智能船舶航向控制方法 | |
CN114265308B (zh) | 一种自主水面航行器的抗饱和无模型预设性能轨迹跟踪控制方法 | |
CN112363393A (zh) | 无人艇动力定位的无模型自适应预设性能控制方法 | |
Dai et al. | Finite-time trajectory tracking for marine vessel by nonsingular backstepping controller with unknown external disturbance | |
CN117452827B (zh) | 一种欠驱动无人艇轨迹跟踪控制方法 | |
Fu et al. | Discrete-time adaptive predictive sliding mode trajectory tracking control for dynamic positioning ship with input magnitude and rate saturations | |
CN109828586B (zh) | 基于非线性不确定性的无人船舶鲁棒h∞航向控制方法 | |
Li et al. | Underactuated Autonomous Underwater Vehicle Trajectory Tracking Control in Three Dimensions Based on Fractional Order Sliding Mode | |
CN117472060B (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 |