CN110308726B - 基于非线性反步法的欠驱动船舶航向控制方法 - Google Patents

基于非线性反步法的欠驱动船舶航向控制方法 Download PDF

Info

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
Application number
CN201910625738.XA
Other languages
English (en)
Other versions
CN110308726A (zh
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.)
Shanghai Maritime University
Original Assignee
Shanghai Maritime 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 Shanghai Maritime University filed Critical Shanghai Maritime University
Priority to CN201910625738.XA priority Critical patent/CN110308726B/zh
Publication of CN110308726A publication Critical patent/CN110308726A/zh
Application granted granted Critical
Publication of CN110308726B publication Critical patent/CN110308726B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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

本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为反步法设计中所需的可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助系统的解决办法,所提出基于反步法的控制方法可以使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,有效减少航向误差,改善控制性能。

Description

基于非线性反步法的欠驱动船舶航向控制方法
技术领域
涉及船舶航向控制领域,具体涉及一种基于非线性反步法的欠驱动船舶航向控制方法。
背景技术
随着对海洋资源的开发利用,船舶控制领域也成为研究热点。大多传统船舶通常是欠驱动的,即只在横荡和艏摇方向上运动,如何更准确的对欠驱动船舶进行航向控制,引起众多国内外学者的关注。输入饱和是实际控制系统中的一种常见现象,如果执行器的输入达到一定的极限,就会进入饱和状态导致系统性能降低,甚至导致闭环系统的不稳定,也会增加舵的损耗。反步法将额外产生的非线性引入控制过程,以消除系统中不希望出现的非线性,具有完备的自适应和鲁棒控制理论,在船舶控制领域中有着广泛的应用。但是基于反步法进行航向控制设计是在保证虚拟控制律中所有函数均可导的前提下进行的,如何解决饱和约束的非线性及如何避免虚拟控制律求导时的复杂运算,这些都是使用反步法进行设计时需要解决的难题。
发明内容
本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为反步法设计中所需的可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助系统的解决办法,所提出基于反步法的控制方法可以使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,有效减少航向误差,改善控制性能。
主要包括以下步骤:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
Figure BDA0002127030240000011
Figure BDA0002127030240000012
Figure BDA0002127030240000013
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶系统惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi,i=1,2为艏摇和横荡方向上有未知界的外部干扰,
Figure BDA00021270302400000211
是控制系统中唯一的控制输入量,
Figure BDA00021270302400000212
是饱和执行器的输出,如下:
Figure BDA0002127030240000021
其中τ-<0,τ+>0分别代表约束的下限和上限。
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
为了利用反步法开发控制器,将
Figure BDA00021270302400000213
分为两部分,即
Figure BDA0002127030240000022
其中定义了双曲正切函数的光滑函数
Figure BDA00021270302400000215
来近似饱和非线性为
Figure BDA0002127030240000023
假设
Figure BDA00021270302400000214
有界,设为b,得
Figure BDA0002127030240000024
则式(1)可以改写如下:
Figure BDA0002127030240000025
其中
Figure BDA0002127030240000026
因为ωr
Figure BDA0002127030240000027
有界,所以假设Δ≤σ,定义
Figure BDA0002127030240000028
为σ的估计值,其估计误差为
Figure BDA0002127030240000029
c为正常数,φ为后续需要设计的辅助信号。
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助系统来简化求导过程;
Figure BDA00021270302400000210
其中αi0,i=1,2表示需要设计的虚拟控制律,可以得到
Figure BDA0002127030240000031
通过系统输出得到x1i=αi
Figure BDA0002127030240000032
滤波器的估计误差为αii0=Δαi,ξi>0和ωi>0是滤波器参数,
Figure BDA0002127030240000033
其中aijm是aij,i=1,2,j=0,1的界。
步骤4、下达期望航向指令,即设定期望航向角ψd
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα1 (12)
Figure BDA0002127030240000034
其中zi,i=1,2,3为辅助变量,αi0,i=1,2表示虚拟镇定函数,具体如下
Figure BDA0002127030240000035
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助系统,即
Figure BDA0002127030240000036
其中常数ke1>1,γ1>0,
Figure BDA0002127030240000037
是一个非常小的常数,且
Figure BDA0002127030240000038
则α20可选择为
Figure BDA0002127030240000039
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助系统,即
Figure BDA00021270302400000310
其中常数ke2>1,γ2>0,
Figure BDA00021270302400000313
是一个很小正数,对于|e2|≠0,
Figure BDA00021270302400000311
为了解决ofσ的估计误差,设计自适应律
Figure BDA00021270302400000312
Figure BDA0002127030240000041
其中常数γσ>0,γf>0;
定义一个有界信号θ为
Figure BDA0002127030240000042
引入如下的Nussbaum函数:
Figure BDA0002127030240000043
其中常数γη>0,设计辅助信号φ为
Figure BDA0002127030240000044
其中常数k3>0。
步骤6、系统更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。
本方法具有如下效果和优点:
通过引入双曲正切函数和Nussbaum函数对控制输入饱和约束进行逼近,成功将非线性函数转化为反步法设计中所需的可导连续函数,设计的自适应律可以实现对逼近误差和外部扰动有效的估计处理,结合反步控制算法的辅助系统滤波器解决了虚拟控制律复杂求导的难题。该航向控制算法可以在较短的时间内使系统达到稳定,使非线性欠驱动船舶始终以很小的控制输入力矩保持航向航行,提高了船舶航向控制性能。
附图说明
图1为本发明设计的滤波器结构框图
具体实施方式
本发明提出了一种基于非线性反步法的欠驱动船舶航向控制方法,引入双曲正切函数和Nussbaum函数对控制输入饱和约束函数进行逼近,转化为可导连续函数,并结合自适应律对逼近误差和外部扰动进行估计处理,另外为避免反步法中虚拟控制律的复杂求导过程,提出一种滤波器辅助系统的解决办法,基于反步法构成完整控制系统。包括以下步骤:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
Figure BDA0002127030240000051
Figure BDA0002127030240000052
Figure BDA0002127030240000053
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶系统惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi(i=1,2)为艏摇和横荡方向上有未知界的外部干扰,
Figure BDA0002127030240000058
是控制系统中唯一的控制输入量,
Figure BDA00021270302400000510
是饱和执行器的输出,如下:
Figure BDA0002127030240000054
其中τ-<0,τ+>0分别代表约束的下限和上限。
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
为了利用反步法开发控制器,将
Figure BDA0002127030240000059
分为两部分,即
Figure BDA0002127030240000055
其中定义了双曲正切函数的光滑函数
Figure BDA00021270302400000512
来近似饱和非线性为
Figure BDA0002127030240000056
假设
Figure BDA00021270302400000511
有界,设为b,得
Figure BDA0002127030240000057
则式(1)可以改写如下:
Figure BDA0002127030240000061
其中
Figure BDA0002127030240000062
因为ωr
Figure BDA00021270302400000610
有界,所以假设Δ≤σ,定义
Figure BDA00021270302400000611
为σ的估计值,其估计误差为
Figure BDA0002127030240000063
c为正常数,φ为后续需要设计的辅助信号。
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助系统来简化求导过程;
Figure BDA0002127030240000064
其中αi0,i=1,2表示需要设计的虚拟控制律,可以得到
Figure BDA0002127030240000065
通过系统输出得到x1i=αi
Figure BDA0002127030240000066
滤波器的估计误差为αii0=Δαi,ξi>0和ωi>0是滤波器参数,
Figure BDA0002127030240000067
其中aijm是aij,i=1,2,j=0,1的界。
步骤4、下达期望航向指令,即设定期望航向角ψd
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα 1 (12)
Figure BDA0002127030240000068
其中zi(i=1,2,3)为辅助变量,αi0(i=1,2)表示虚拟镇定函数,具体如下
Figure BDA0002127030240000069
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助系统,即
Figure BDA0002127030240000071
其中常数ke1>1,γ1>0,
Figure BDA0002127030240000072
是一个非常小的常数,且
Figure BDA0002127030240000073
则α20可选择为
Figure BDA0002127030240000074
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助系统,即
Figure BDA0002127030240000075
其中常数ke2>1,γ2>0.
Figure BDA00021270302400000712
是一个很小正数,对于|e2|≠0,
Figure BDA0002127030240000076
为了解决ofσ的估计误差,设计自适应律
Figure BDA0002127030240000077
Figure BDA0002127030240000078
其中常数γσ>0,γf>0;
定义一个有界信号θ为
Figure BDA0002127030240000079
引入如下的Nussbaum函数:
Figure BDA00021270302400000710
其中常数γη>0,设计辅助信号φ为
Figure BDA00021270302400000711
其中常数k3>0。
步骤6、系统更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。

Claims (1)

1.一种基于非线性反步法的欠驱动船舶航向控制方法,其特征在于:
步骤1、建立2自由度欠驱动船舶数学模型;
基于假设垂荡、横摇、纵摇运动可忽略不计,欠驱动船舶动力学模型可以简化为在横荡和艏摇方向上的两自由度运动,可归结如下:
Figure FDA0002127030230000011
Figure FDA0002127030230000012
Figure FDA0002127030230000013
其中假设u是船舶恒定的纵荡速度,横荡速度v被动有界且足够小,r、ψ分别表示非线性欠驱动船舶艏摇角频率和艏摇角,对于i=11,22,33,参数mi表示包括附加质量的船舶系统惯性,f1(r)和f2(v)分别是艏摇、横荡运动中的水动力阻尼部分,对于i=1,2,3,dri和dvi是阻尼系数,λ是一个很小的正常数,ωr和ωvi,i=1,2为艏摇和横荡方向上有未知界的外部干扰,
Figure FDA0002127030230000014
是控制系统中唯一的控制输入量,
Figure FDA0002127030230000015
是饱和执行器的输出,如下:
Figure FDA0002127030230000016
其中τ-<0,τ+>0分别代表约束的下限和上限;
步骤2、引入双曲正切函数对控制输入饱和约束进行逼近,转化为反步法设计中所需的可导连续函数;
为了利用反步法开发控制器,将
Figure FDA0002127030230000017
分为两部分,即
Figure FDA0002127030230000018
其中定义了双曲正切函数的光滑函数
Figure FDA0002127030230000019
来近似饱和非线性为
Figure FDA00021270302300000110
假设
Figure FDA00021270302300000111
有界,设为b,得
Figure FDA0002127030230000021
则式(1)可以改写如下:
Figure FDA0002127030230000022
其中
Figure FDA00021270302300000210
因为ωr
Figure FDA00021270302300000211
有界,所以假设Δ≤σ,定义
Figure FDA0002127030230000023
为σ的估计值,其估计误差为
Figure FDA0002127030230000024
c为正常数,φ为后续需要设计的辅助信号;
步骤3、为了避免后续计算中出现对所设计的虚拟控制律进行复杂求导的情况出现,引入一种滤波器作为辅助系统来简化求导过程;
Figure FDA0002127030230000025
其中αi0,i=1,2表示需要设计的虚拟控制律,可以得到
Figure FDA0002127030230000026
通过系统输出得到x1i=αi
Figure FDA0002127030230000027
滤波器的估计误差为αii0=Δαi,ξi>0和ωi>0是滤波器参数,
Figure FDA0002127030230000028
其中aijm是aij,i=1,2,j=0,1的界;
步骤4、下达期望航向指令,即设定期望航向角ψd
步骤5、设计航向控制所需的控制律及自适应律;
结合步骤3引入新变量进行状态转换
z1=ψ-ψd (11)
z2=r-α10-Δα1 (12)
Figure FDA0002127030230000029
其中zi,i=1,2,3为辅助变量,αi0,i=1,2表示虚拟镇定函数,具体如下
Figure FDA0002127030230000031
其中常数k1>0,ka1>0,e1是用来估计和消除误差Δα1的辅助系统,即
Figure FDA0002127030230000032
其中常数ke1>1,γ1>0,
Figure FDA0002127030230000033
是一个非常小的常数,且
Figure FDA0002127030230000034
则α20可选择为
Figure FDA0002127030230000035
其中常数k2>0,ka2>0,υ>0,e2是用来估计和消除误差Δα2的辅助系统,即
Figure FDA0002127030230000036
其中常数ke2>1,γ2>0.
Figure FDA0002127030230000037
是一个很小正数,对于|e2|≠0,
Figure FDA0002127030230000038
为了解决ofσ的估计误差,设计自适应律
Figure FDA0002127030230000039
Figure FDA00021270302300000310
其中常数γσ>0,γf>0;
定义一个有界信号θ为
Figure FDA00021270302300000311
引入如下的Nussbaum函数:
Figure FDA00021270302300000312
其中常数γη>0,设计辅助信号φ为
Figure FDA00021270302300000313
其中常数k3>0;
步骤6、系统更新当前船舶运动状态量,即ψ、r、v,并转到步骤3。
CN201910625738.XA 2019-07-11 2019-07-11 基于非线性反步法的欠驱动船舶航向控制方法 Active CN110308726B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 北京航空航天大学 一种基于受限反步法控制的欠驱动无人船轨迹跟踪方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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) 一种垂直起降重复使用运载器的自适应容错控制方法
CN110673611B (zh) 一种基于事件触发方案和t-s模糊系统的欠驱动无人艇控制方法
CN107544256B (zh) 基于自适应反步法的水下机器人滑模控制方法
CN108319140B (zh) 一种重定义输出式无模型自适应航向控制方法及系统
CN110244556B (zh) 基于期望航向修正的欠驱动船舶航向控制方法
CN110262494B (zh) 一种同构多无人艇系统的协同学习与编队控制方法
CN108170151B (zh) 一种水下机器人的自适应运动控制装置及其方法
CN110018637B (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多端口事件触发路径跟踪控制方法
CN113110511B (zh) 一种基于广义模糊双曲模型的智能船舶航向控制方法
CN114265308B (zh) 一种自主水面航行器的抗饱和无模型预设性能轨迹跟踪控制方法
Liu et al. Adaptive command filtered backstepping tracking control for AUVs considering model uncertainties and input saturation
CN111381595B (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∞航向控制方法
CN110109357A (zh) 针对非标准型非线性航空器的半全局自适应控制方法
CN115793460A (zh) 一种带有推进器饱和的无人船量化滑模容错控制方法
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