CN113093735B - 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质 - Google Patents

随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质 Download PDF

Info

Publication number
CN113093735B
CN113093735B CN202110288586.6A CN202110288586A CN113093735B CN 113093735 B CN113093735 B CN 113093735B CN 202110288586 A CN202110288586 A CN 202110288586A CN 113093735 B CN113093735 B CN 113093735B
Authority
CN
China
Prior art keywords
under
unmanned ship
error
cross
function
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
CN202110288586.6A
Other languages
English (en)
Other versions
CN113093735A (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.)
South China Sea Survey Technology Center State Oceanic Administration (south China Sea Marine Buoy Center)
South China University of Technology SCUT
Original Assignee
South China Sea Survey Technology Center State Oceanic Administration (south China Sea Marine Buoy Center)
South China University of Technology SCUT
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 South China Sea Survey Technology Center State Oceanic Administration (south China Sea Marine Buoy Center), South China University of Technology SCUT filed Critical South China Sea Survey Technology Center State Oceanic Administration (south China Sea Marine Buoy Center)
Priority to CN202110288586.6A priority Critical patent/CN113093735B/zh
Publication of CN113093735A publication Critical patent/CN113093735A/zh
Application granted granted Critical
Publication of CN113093735B publication Critical patent/CN113093735B/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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

Abstract

本发明公开了一种随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质,该方法针对在随机扰动下的欠驱动无人艇设计控制,设计跟踪误差的暂态性能和稳态性能指标,构造横截函数引入额外控制输入,完成控制器的设计,并保证跟踪误差最终有界。包括步骤:构建欠驱动无人艇标准的非线性随机模型形式的动力学模型;设计速度误差方程并引入附加的控制变量;采用tan型障碍李雅普诺夫函数确保跟踪误差满足预设暂态性能的约束条件;运用自适应控制技术解决控制器设计中的模型不确定问题。本发明所设计的控制方法可以解决欠驱动水面船舶运动控制的难点,并且实现了随机干扰环境下航迹的跟踪控制,提高控制系统的跟踪误差稳态性能及暂态性能。

Description

随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系 统及介质
技术领域
本发明属于欠驱动无人艇的轨迹跟踪控制技术的技术领域,具体涉及一种随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质。
背景技术
近些年,无人艇的应用广泛,在环境监测、海上救援等方面发挥极其重要的作用。无人艇轨迹跟踪控制成为当下研究的重点课题。
在实际环境中,无人艇系统通过螺旋桨和船舵转矩实现三个方向的运动控制,它是一类欠驱动系统,即他的独立控制执行器个数小于自由度的个数。研究欠驱动无人艇的轨迹跟踪控制是一个非常有挑战性的问题。目前对于欠驱动船舶跟踪控制设计问题,研究人员通常预先要求所跟踪的期望参考轨迹是可行的或者是满足持续激励条件的。因此,目前存在的欠驱动水面船舶控制方法无法实现对任意光滑的参考轨迹进行跟踪控制。本专利采用横截函数的方法引入一个额外控制,来解决欠驱动控制设计难题,实现对任意光滑的参考轨迹进行跟踪控制。
在海面航行的时候,环境中的洋流、海风、海浪会对无人艇的运行造成干扰,影响控制性能,甚至可能导致系统不稳定。在实际环境中,洋流、海风、海浪都是归于一类随机干扰,而现有的控制方法大多只针对确定性系统,不考虑随机干扰。鉴于无人艇经常受到风、浪和海流的干扰,用非线性随机系统描述无人艇比确定性系统更为准确。近几年,研究人员提出了针对非线性随机系统进行控制的方法,将基于确定性系统理论的反步法已经扩展到随机系统领域,但由于状态耦合等问题,该方法不能直接应用于无人艇系统。因此需要对处于随机干扰下的欠驱动无人艇进行控制器设计。
跟踪误差约束也是无人艇轨迹控制中的一个难点。在实际的无人艇航行过程中,如果不对误差进行约束,会严重影响无人艇的性能和稳定性,在狭窄的水道中航行时,无人艇可能会碰撞周围的障碍,造成巨大的损失。由此来看,不约束跟踪误差对于无人船的控制是非常不安全的。因此需要对跟踪误差进行约束。
发明内容
本发明的主要目的在于克服现有技术的缺点与不足,提供一种随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质,根据该控制方法能确保输出误差始终处在一个预先指定的范围内,误差满足预先指定的边界,并且能够使输出跟踪误差有界。
为了达到上述目的,本发明采用以下技术方案:
本发明提供了一种随机扰动下输出受限欠驱动无人艇的横截函数控制方法,包括下述步骤:
S1、建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;
S2、运用反步设计法针对误差系统进行虚拟控制器设计;
S3、设计速度误差方程,引入额外控制;
S4、估计无人船模型中的未知参数θ和Δ;
S5、应用tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器。
作为优选的技术方案,所述建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,并定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差具体为:
Figure BDA0002981457280000021
Figure BDA0002981457280000022
Figure BDA0002981457280000023
Figure BDA0002981457280000024
Figure BDA0002981457280000025
Figure BDA0002981457280000026
其中,
Figure BDA0002981457280000027
Figure BDA0002981457280000028
Figure BDA0002981457280000029
其中,参数mij是dij与船舶相关的参数,τu和τr为控制输入,τwu,τwv,τwr为随机扰动以及三个阻尼系数分别为
Figure BDA00029814572800000210
Figure BDA0002981457280000031
x,y,ψ表示无人艇在大地坐标系(OeXeYe)下的位置(x,y)和大地坐标系下的航向角Ψ;u,ν,r对应于体坐标系(oexeye)下的前进速度、横荡速度和转向角速度;
随机扰动τwu,τwv,τwr具体如下式:
Figure BDA0002981457280000032
Figure BDA0002981457280000033
Figure BDA0002981457280000034
其中
Figure BDA0002981457280000035
Figure BDA0002981457280000036
分别表示τwu的确定和随机分量,且确定分量视为未知常量,随机分量被认为是高斯随机扰动并使用维纳过程对其进行建模,具体如下:
Figure BDA0002981457280000037
Figure BDA0002981457280000038
其中,Δi(t),i=1,2,3表示时变协方差矩阵,
Figure BDA0002981457280000039
表示维纳过程,点表示导数;
得到最后的随机差分方程为:
dx=(u cos(ψ)-ν sin(ψ))dt,
dy=(usin(ψ)+v cos(ψ))dt,
dψ=rdt,
Figure BDA00029814572800000310
Figure BDA00029814572800000311
Figure BDA00029814572800000312
跟踪误差的具体定义为:
z11=x-xd
z12=y-yd
z13=ψ-ψd
其中,z1i,i=1,2,3为设计的无人艇的跟踪距离误差和方位角误差,
所述跟踪误差满足以下约束条件:
|z1i|<kb1i,i=1,2,3,
其中,kb1i为时变函数。
作为优选的技术方案,所述设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束具体为:
Figure BDA0002981457280000041
当设计的控制器能保证tan型障碍李雅普诺夫函数V始终有界,则跟踪误差z1i始终满足|z1i|<kb1i,且跟踪的方位变量(x,y)和跟踪的方位角变量ψ始终满足约束条件:
-kb1i<z1i<kb1i
约束条件表示误差z1i的超调量始终小于函数kb1i所构造的边界。
作为优选的技术方案,所述运用反步设计法针对误差系统进行虚拟控制器设计,得到的虚拟控制器为:
α1=φ1 cosψ+φ2 sinψ,
α2=-φ1 sinψ+φ2 cosψ,
Figure BDA0002981457280000042
其中,
Figure BDA0002981457280000043
设计参数为k11>0,k12>0,k13>0。
作为优选的技术方案,所述设计速度误差方程,引入额外控制具体如下式:
Figure BDA0002981457280000044
其中,u,v,r分别为船舶的纵向速度、横荡速度、转向角速度;αi,i=1,2,3为虚拟控制输入;h1(β)和h2(β)为引入的横截函数,
Figure BDA0002981457280000045
为引入的额外控制输入。
作为优选的技术方案,引入的横截函数具体为:
Figure BDA0002981457280000046
Figure BDA0002981457280000047
其中
Figure BDA0002981457280000048
因此,推导出:
Figure BDA0002981457280000049
Figure BDA00029814572800000410
Figure BDA00029814572800000411
Figure BDA0002981457280000051
其中,ε1为正常数,ε2为正常数,h1和h2为横截函数。
作为优选的技术方案,所述估计无人船模型中的未知参数θ和Δ,也即未知参数θ和
Figure BDA0002981457280000052
其估计值的自适应更新律设计为:
Figure BDA0002981457280000053
Figure BDA0002981457280000054
Figure BDA0002981457280000055
Figure BDA0002981457280000056
Figure BDA0002981457280000057
Figure BDA0002981457280000058
其中μi,ιi,i=1,2,3为自适应增益常数且满足μi,ιi>0,kθi,kδi,i=1,2,3为正常数。
作为优选的技术方案,所述应用tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器具体为:
Figure BDA0002981457280000059
Figure BDA00029814572800000510
Figure BDA00029814572800000511
其中,
Figure BDA00029814572800000512
Figure BDA00029814572800000513
Figure BDA00029814572800000514
k31>0,k21>0,k22>0为设计参数。
本发明还提供了一种随机扰动下输出受限欠驱动无人艇的横截函数控制系统,包括欠驱动无人艇模型构建模块、虚拟控制器设计模块、速度误差额外控制模块、参数估计模块和跟踪控制器构建模块;
所述欠驱动无人艇模型构建模块用于建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;
所述虚拟控制器设计模块用于根据反步设计法针对误差系统进行虚拟控制器设计;
所述速度误差额外控制模块用于设计速度误差方程,引入额外控制;
所述参数估计模块用于估计无人船模型中的未知参数θ和Δ;
所述跟踪控制器构建模块用于根据tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器。
本发明还提供了一种存储介质,存储有程序,所述程序被处理器执行时,实现所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法。
本发明与现有技术相比,具有如下优点和有益效果:
(1)与目前存在的欠驱动水面船舶轨迹跟踪控制方法相比,本发明在李雅普洛夫函数综合设计方法中引入具有对称边界的正切函数,确保误差不超过预先设定的约束范围,并保证收敛速度及超调量满足预先设定的条件,提高系统的性能。
(2)本发明所设计的控制器为自适应控制器。由于海洋环境中通常存在洋流、海风、海浪等随机扰动,根据非线性随机系统对系统进行描述,利用其有限元所设计出的控制器来进行轨迹跟踪,以达到无人艇系统保持稳定运行的能力。
(3)本发明通过使用横截函数引入额外控制,解决了欠驱动无人艇在横荡方向缺少控制输入的问题,同时可以让欠驱动无人艇跟踪任何轨迹。
附图说明
图1是本发明实施例的工作区域中的无人艇结构示意图;
图2为本发明实施例的无人艇系统的整体控制框图;
图3为本发明实施例的无人艇大地坐标系下位置x误差仿真图框图;
图4为本发明实施例的无人艇大地坐标系下位置y误差仿真图框图;
图5为本发明实施例的无人艇大地坐标系下方位角ψ误差仿真图框图;
图6为本发明实施例的控制器τu输出仿真图;
图7为本发明实施例的控制器τu输出仿真图;
图8为本发明实施例的控制器β输出仿真图;
图9为本发明实施例的参数估计值
Figure BDA0002981457280000061
的范数仿真图;
图10为本发明实施例的参数估计值
Figure BDA0002981457280000062
的范数仿真图;
图11为本发明实施例的随机扰动下输出受限欠驱动无人艇的横截函数控制系统的结构示意图;
图12为本发明实施例的存储介质的结构示意图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
实施例
本实施例主要阐述基于横截函数的随机扰动下的欠驱动无人艇输出受限控制方法,图1为本实施例的工作区域中的无人艇结构示意图。
如图2所示,本实施例提供了一种随机扰动下输出受限欠驱动无人艇的横截函数控制方法,包括以下步骤:
S1、建立欠驱动无人艇模型,由于环境中存在随机干扰,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;
更为具体的,步骤S1中,水面船舶展开后的动态模型具体为:
Figure BDA0002981457280000071
Figure BDA0002981457280000072
Figure BDA0002981457280000073
Figure BDA0002981457280000074
Figure BDA0002981457280000075
Figure BDA0002981457280000076
其中,
Figure BDA0002981457280000077
Figure BDA0002981457280000078
Figure BDA0002981457280000081
其中,参数mij是dij与船舶相关的参数,τu和τr为控制输入,τwu,τwv,τwr为随机扰动以及三个阻尼系数分别为
Figure BDA0002981457280000082
Figure BDA0002981457280000083
x,y,ψ表示无人艇在大地坐标系(OeXeYe)下的位置(x,y)和大地坐标系下的航向角Ψ;u,v,r对应于体坐标系(oexeye)下的前进速度、横荡速度和转向角速度;
更为具体的,步骤S1中,随机扰动τwu,τwv,τwr具体如下式:
Figure BDA0002981457280000084
Figure BDA0002981457280000085
Figure BDA0002981457280000086
其中
Figure BDA0002981457280000087
Figure BDA0002981457280000088
分别表示τwu的确定和随机分量,且确定分量视为未知常量,随机分量被认为是高斯随机扰动并使用维纳过程对其进行建模,具体如下:
Figure BDA0002981457280000089
Figure BDA00029814572800000810
其中,Δi(t),i=1,2,3表示时变协方差矩阵,
Figure BDA00029814572800000811
表示维纳过程,点表示导数;
更为具体的,步骤S1中,得到最后的随机差分方程为:
dx=(u cos(ψ)-v sin(ψ))dt,
dy=(u sin(ψ)+v cos(ψ))dt,
dψ=rdt,
Figure BDA00029814572800000812
Figure BDA00029814572800000813
Figure BDA00029814572800000814
跟踪误差的具体定义为:
z11=x-xd
z12=y-yd
z13=ψ-ψd
其中,z1i,i=1,2,3为设计的无人艇的跟踪距离误差和方位角误差,
所述跟踪误差满足以下约束条件:
|z1i|<kb1i,i=1,2,3,
其中,kb1i为时变函数。
更为具体的,步骤S1中,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束具体为:
Figure BDA0002981457280000091
当设计的控制器能保证tan型障碍李雅普诺夫函数V始终有界,则跟踪误差z1i始终满足|z1i|<kb1i,且跟踪的方位变量(x,y)和跟踪的方位角变量ψ始终满足约束条件:
-kb1i<z1i<kb1i
约束条件表示误差z1i的超调量始终小于函数kb1i所构造的边界。
更进一步的,在本实例中,选取的欠驱动水面船舶系统相关参数分别为:m11=25.8kg,m22=33.8kg,m23=1.0948kg,m33=2.76kg,τwv=0.5*m22(1.5+cos(t))+0.5*m23(1.5+sin(t)),τwr=0.5*m23(1.5+cos(t))+0.5*m33(1.5+sin(t)),kb11=2e-0.1t+0.2,kb12=2e-0.1t+0.2,kb13=3e-0.5t+5。
图3、图4、图5分别为无人艇的跟踪距离误差(也即位置x的误差、位置y的误差,z11和z12)和方位角ψ误差z13随时间的变化图,可见距离误差(z11和z12)和方位角ψ误差z13,在调节过程中始终满足约束条件。
S2、运用反步设计法针对误差系统进行虚拟控制器设计,得到的虚拟控制器为:
α1=φ1 cosψ+φ2 sinψ,
α2=-φ1 sinψ+φ2 cosψ,
Figure BDA0002981457280000092
其中,
Figure BDA0002981457280000093
设计参数为k11>0,k12>0,k13>0。
更进一步的,在本实施例中,选取k11=10,k12=10,k13=0.001。
S3、设计速度误差方程,引入额外控制解决欠驱动控制难题:
Figure BDA0002981457280000094
其中,u,ν,r分别为船舶的纵向速度、横荡速度、转向角速度;αi,i=1,2,3为虚拟控制输入;h1(β)和h2(β)为引入的横截函数,
Figure BDA0002981457280000101
为引入的额外控制输入,用于解决欠驱动机械系统控制器设计的难点;
更为具体的,步骤S3中引入的横截函数具体为:
Figure BDA0002981457280000102
Figure BDA0002981457280000103
其中
Figure BDA0002981457280000104
因此,推导出:
Figure BDA0002981457280000105
Figure BDA0002981457280000106
Figure BDA0002981457280000107
Figure BDA0002981457280000108
其中,ε1为正常数,ε2为正常数,h1和h2为横截函数,用来提供额外的控制输入,解决欠驱动无人艇中存在的非零非对角矩阵的问题。
更进一步的,在本实施例中,选取ε1=20,ε2=20。
S4、估计无人船模型中的未知参数θ和Δ,也即未知参数θ和
Figure BDA0002981457280000109
其估计值的自适应更新律设计为:
Figure BDA00029814572800001010
Figure BDA00029814572800001011
Figure BDA00029814572800001012
Figure BDA00029814572800001013
Figure BDA00029814572800001014
Figure BDA00029814572800001015
其中μi,ιi,i=1,2,3为自适应增益常数且满足μi,ιi>0,kθi,kδi,i=1,2,3为正常数;
更进一步的,在本实施例中,选取μ1=1,ι1=1,μ2=1,ι2=1,μ3=1,ι3=1,kθ1=0.01,kδ1=0.01,kθ2=0.01,kδ2=0.01,kθ3=0.01,kδ3=0.01,图9、图10为自适应估计图,自适应法对未知参数进行估计后,可以发现,在自适应估计刚刚开始时有一些波动,因为设计的自适应估计的初始值为0和需要一定的估计时间,一段时间的波动后,能够较好的估计未知参数,为控制器设计提供了帮助。
S5、应用tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器,具体为:
Figure BDA0002981457280000111
Figure BDA0002981457280000112
Figure BDA0002981457280000113
其中,
Figure BDA0002981457280000114
Figure BDA0002981457280000115
Figure BDA0002981457280000116
k31>0,k21>0,k22>0为设计参数。
更进一步的,在本实施例中,选取k31=2,k21=2,k22=1,,
Figure BDA0002981457280000117
的初始值选择为
Figure BDA0002981457280000118
船舶运动状态的初始值选择为η(0)=[1.7,1.7,0.2]T,v(0)=[0,0,0]T。图3、图4、图5分别为欠驱动水面船舶的轨迹跟踪误差示意图,图6和图7为欠驱动水面船舶轨迹跟踪系统控制输入示意图,图8为额外控制输入β示意图,通过加入横截函数,引入了额外的控制输入β,为欠驱动系统跟踪任何光滑或非光滑的轨迹提供了实现算法,可以看见控制器能够保证输出误差不会违反,并且相应的控制输入也是有界的。
如图11所示,在本申请的另一个实施例中,提供了一种随机扰动下输出受限欠驱动无人艇的横截函数控制系统,该系统包括欠驱动无人艇模型构建模块、虚拟控制器设计模块、速度误差额外控制模块、参数估计模块和跟踪控制器构建模块;
所述欠驱动无人艇模型构建模块用于建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;
所述虚拟控制器设计模块用于根据反步设计法针对误差系统进行虚拟控制器设计;
所述速度误差额外控制模块用于设计速度误差方程,引入额外控制;
所述参数估计模块用于估计无人船模型中的未知参数θ和Δ;
所述跟踪控制器构建模块用于根据tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器。
在此需要说明的是,上述实施例提供的系统仅以上述各功能模块的划分进行举例说明,在实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能,该系统是应用于上述实施例的随机扰动下输出受限欠驱动无人艇的横截函数控制方法。
如图12所示,在本申请的另一个实施例中,还提供了一种存储介质,存储有程序,所述程序被处理器执行时,实现随机扰动下输出受限欠驱动无人艇的横截函数控制方法,具体为:
S1、建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;
S2、运用反步设计法针对误差系统进行虚拟控制器设计;
S3、设计速度误差方程,引入额外控制;
S4、估计无人船模型中的未知参数θ和Δ;
S5、应用tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器。
应当理解,本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。

Claims (8)

1.随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,包括下述步骤:
建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;具体为:
Figure FDA0003608198210000011
Figure FDA0003608198210000012
Figure FDA0003608198210000013
Figure FDA0003608198210000014
Figure FDA0003608198210000015
Figure FDA0003608198210000016
其中,
Figure FDA0003608198210000017
Figure FDA0003608198210000018
Figure FDA0003608198210000019
其中,参数mij是dij与船舶相关的参数,τu和τr为控制输入,τwu,τwv,τwr为随机扰动以及三个阻尼系数分别为
Figure FDA00036081982100000110
Figure FDA00036081982100000111
x,y,ψ表示无人艇在大地坐标系OeXeYe下的位置(x,y)和大地坐标系下的航向角Ψ;u,v,r对应于体坐标系oexeye下的前进速度、横荡速度和转向角速度;
随机扰动τwu,τwv,τwr具体如下式:
Figure FDA00036081982100000112
Figure FDA00036081982100000113
Figure FDA00036081982100000114
其中
Figure FDA00036081982100000115
Figure FDA00036081982100000116
分别表示τwu的确定和随机分量,且确定分量视为未知常量,随机分量被认为是高斯随机扰动并使用维纳过程对其进行建模,具体如下:
Figure FDA00036081982100000117
Figure FDA00036081982100000118
其中,Δi(t),i=1,2,3表示时变协方差矩阵,
Figure FDA00036081982100000119
表示维纳过程,点表示导数;
得到最后的随机差分方程为:
dx=(ucos(ψ)-vsin(ψ))dt,
dy=(usin(ψ)+vcos(ψ))dt,
dψ=rdt,
Figure FDA0003608198210000021
Figure FDA0003608198210000022
Figure FDA0003608198210000023
跟踪误差的具体定义为:
z11=x-xd
z12=y-yd
z13=ψ-ψd
其中,z1i,i=1,2,3为设计的无人艇的跟踪距离误差和方位角误差,
所述跟踪误差满足以下约束条件:
|z1i|<b1i,i=1,2,3,
其中,kb1i为时变函数;
运用反步设计法针对误差系统进行虚拟控制器设计;
设计速度误差方程,引入额外控制;
估计无人船模型中的未知参数θ和Δ;
应用tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器,具体为:
Figure FDA0003608198210000024
Figure FDA0003608198210000025
Figure FDA0003608198210000026
其中,
Figure FDA0003608198210000027
Figure FDA0003608198210000028
Figure FDA0003608198210000029
k31>0,k21>0,k22>0为设计参数。
2.根据权利要求1所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,所述设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束具体为:
Figure FDA0003608198210000031
当设计的控制器能保证tan型障碍李雅普诺夫函数V始终有界,则跟踪误差z1i始终满足|z1i|<b1i,且跟踪的方位变量(x,y)和跟踪的方位角变量ψ始终满足约束条件:
-kb1i<z1i<kb1i
约束条件表示误差z1i的超调量始终小于函数kb1i所构造的边界。
3.根据权利要求1所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,所述运用反步设计法针对误差系统进行虚拟控制器设计,得到的虚拟控制器为:
α1=φ1cosψ+φ2sinψ,
α2=-φ1sinψ+φ2cosψ,
Figure FDA0003608198210000032
其中,
Figure FDA0003608198210000033
设计参数为k11>0,k12>0,k13>0。
4.根据权利要求1所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,所述设计速度误差方程,引入额外控制具体如下式:
Figure FDA0003608198210000034
其中,u,v,r分别为船舶的纵向速度、横荡速度、转向角速度;αi,i=1,2,3为虚拟控制输入;h1(β)和h2(β)为引入的横截函数,
Figure FDA0003608198210000035
为引入的额外控制输入。
5.根据权利要求4所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,引入的横截函数具体为:
Figure FDA0003608198210000036
Figure FDA0003608198210000037
其中
Figure FDA0003608198210000038
因此,推导出:
Figure FDA0003608198210000039
Figure FDA00036081982100000310
Figure FDA00036081982100000311
Figure FDA0003608198210000041
其中,ε1为正常数,ε2为正常数,h1和h2为横截函数。
6.根据权利要求1所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,其特征在于,所述估计无人船模型中的未知参数θ和Δ,也即未知参数θ和
Figure FDA0003608198210000042
其估计值的自适应更新律设计为:
Figure FDA0003608198210000043
Figure FDA0003608198210000044
Figure FDA0003608198210000045
Figure FDA0003608198210000046
Figure FDA0003608198210000047
Figure FDA0003608198210000048
其中μii,i=1,2,3为自适应增益常数且满足μii>0,kθi,kδi,i=1,2,3为正常数。
7.随机扰动下输出受限欠驱动无人艇的横截函数控制系统,其特征在于,应用于权利要求1-6中任一项所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法,包括欠驱动无人艇模型构建模块、虚拟控制器设计模块、速度误差额外控制模块、参数估计模块和跟踪控制器构建模块;
所述欠驱动无人艇模型构建模块用于建立欠驱动无人艇模型,将无人船动力学模型转化为标准的非线性随机模型形式,设计控制系统的稳态及暂态性能要求:定义水面船舶的位置和航向角与任意参考轨迹之间的跟踪误差,设计tan型障碍李雅普诺夫函数并对预设性能的跟踪误差约束;具体为:
Figure FDA0003608198210000049
Figure FDA00036081982100000410
Figure FDA00036081982100000411
Figure FDA00036081982100000412
Figure FDA00036081982100000413
Figure FDA00036081982100000414
其中,
Figure FDA0003608198210000051
Figure FDA0003608198210000052
Figure FDA0003608198210000053
其中,参数mij是dij与船舶相关的参数,τu和τr为控制输入,τwu,τwv,τwr为随机扰动以及三个阻尼系数分别为
Figure FDA0003608198210000054
Figure FDA0003608198210000055
x,y,ψ表示无人艇在大地坐标系OeXeYe下的位置(x,y)和大地坐标系下的航向角Ψ;u,v,r对应于体坐标系oexeye下的前进速度、横荡速度和转向角速度;
随机扰动τwu,τwv,τwr具体如下式:
Figure FDA0003608198210000056
Figure FDA0003608198210000057
Figure FDA0003608198210000058
其中
Figure FDA0003608198210000059
Figure FDA00036081982100000510
分别表示τwu的确定和随机分量,且确定分量视为未知常量,随机分量被认为是高斯随机扰动并使用维纳过程对其进行建模,具体如下:
Figure FDA00036081982100000511
Figure FDA00036081982100000512
其中,Δi(t),i=1,2,3表示时变协方差矩阵,
Figure FDA00036081982100000513
表示维纳过程,点表示导数;
得到最后的随机差分方程为:
dx=(ucos(ψ)-νsin(ψ))dt,
dy=(usin(ψ)+vcos(ψ))dt,
dψ=rdt,
Figure FDA00036081982100000514
Figure FDA00036081982100000515
Figure FDA00036081982100000516
跟踪误差的具体定义为:
z11=x-xd
z12=y-yd
z13=ψ-ψd
其中,z1i,i=1,2,3为设计的无人艇的跟踪距离误差和方位角误差,
所述跟踪误差满足以下约束条件:
|z1i|<kb1i,i=1,2,3,
其中,kb1i为时变函数;
所述虚拟控制器设计模块用于根据反步设计法针对误差系统进行虚拟控制器设计;
所述速度误差额外控制模块用于设计速度误差方程,引入额外控制;
所述参数估计模块用于估计无人船模型中的未知参数θ和Δ;
所述跟踪控制器构建模块用于根据tan型障碍李雅普诺夫函数、自适应控制技术、横截函数并结合后推设计方法构造稳定的跟踪控制器,,具体为:
Figure FDA0003608198210000061
Figure FDA0003608198210000062
Figure FDA0003608198210000063
其中,
Figure FDA0003608198210000064
Figure FDA0003608198210000065
Figure FDA0003608198210000066
k31>0,k21>0,k22>0为设计参数。
8.一种存储介质,存储有程序,其特征在于,所述程序被处理器执行时,实现权利要求1-6任一项所述的随机扰动下输出受限欠驱动无人艇的横截函数控制方法。
CN202110288586.6A 2021-03-18 2021-03-18 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质 Active CN113093735B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110288586.6A CN113093735B (zh) 2021-03-18 2021-03-18 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110288586.6A CN113093735B (zh) 2021-03-18 2021-03-18 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质

Publications (2)

Publication Number Publication Date
CN113093735A CN113093735A (zh) 2021-07-09
CN113093735B true CN113093735B (zh) 2022-07-26

Family

ID=76668424

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110288586.6A Active CN113093735B (zh) 2021-03-18 2021-03-18 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质

Country Status (1)

Country Link
CN (1) CN113093735B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU94038997A (ru) * 1994-10-07 1996-08-27 Центральный научно-исследовательский институт "Гранит" Устройство сопровождения траекторий движущихся объектов
EP2728424A1 (en) * 2011-06-30 2014-05-07 Universidad Nacional De Educacion A Distancia Guidance method and system using derivative control
CN106228850A (zh) * 2014-12-30 2016-12-14 江苏理工学院 基于滚动规划策略的船舶轨迹实时预测方法
CN107015562A (zh) * 2017-04-26 2017-08-04 华南理工大学 一种满足预设跟踪性能的欠驱动水面船舶控制方法
CN107121928A (zh) * 2017-05-22 2017-09-01 华南理工大学 一种无人水面艇的扰动补偿控制方法
CN108008628A (zh) * 2017-11-17 2018-05-08 华南理工大学 一种不确定欠驱动无人艇系统的预设性能控制方法
CN110865539A (zh) * 2019-11-18 2020-03-06 华南理工大学 一种随机干扰下的无人艇跟踪误差约束控制方法
CN111694365A (zh) * 2020-07-01 2020-09-22 武汉理工大学 一种基于深度强化学习的无人船艇编队路径跟踪方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103955218B (zh) * 2014-04-28 2017-07-25 上海大学 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
WO2015180171A1 (en) * 2014-05-30 2015-12-03 SZ DJI Technology Co., Ltd. Aircraft attitude control methods
CN110618611A (zh) * 2019-10-23 2019-12-27 哈尔滨工程大学 一种基于回转率约束的无人艇轨迹跟踪安全控制方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU94038997A (ru) * 1994-10-07 1996-08-27 Центральный научно-исследовательский институт "Гранит" Устройство сопровождения траекторий движущихся объектов
EP2728424A1 (en) * 2011-06-30 2014-05-07 Universidad Nacional De Educacion A Distancia Guidance method and system using derivative control
CN106228850A (zh) * 2014-12-30 2016-12-14 江苏理工学院 基于滚动规划策略的船舶轨迹实时预测方法
CN107015562A (zh) * 2017-04-26 2017-08-04 华南理工大学 一种满足预设跟踪性能的欠驱动水面船舶控制方法
CN107121928A (zh) * 2017-05-22 2017-09-01 华南理工大学 一种无人水面艇的扰动补偿控制方法
CN108008628A (zh) * 2017-11-17 2018-05-08 华南理工大学 一种不确定欠驱动无人艇系统的预设性能控制方法
CN110865539A (zh) * 2019-11-18 2020-03-06 华南理工大学 一种随机干扰下的无人艇跟踪误差约束控制方法
CN111694365A (zh) * 2020-07-01 2020-09-22 武汉理工大学 一种基于深度强化学习的无人船艇编队路径跟踪方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Disturbance Attenuation Control via Time-varying Input-to-State Stability Tracking Control Lyapunov Functions;Yasuhiro Fujii,等;《2020 59th Annual Conference of the Society of Instrument and Control Engineers of Japan (SICE)》;20201231;第1-9,43页 *
董超,等.无人水面艇海洋调查国内应用进展与展望.《导航与控制》.2019, *

Also Published As

Publication number Publication date
CN113093735A (zh) 2021-07-09

Similar Documents

Publication Publication Date Title
CN108803632B (zh) 基于饱和补偿技术的水面无人艇全状态约束轨迹跟踪控制方法
WO2022000945A1 (zh) DoS攻击下基于切换T-S模糊系统的无人船艇控制方法
CN109917657B (zh) 动力定位船舶的抗干扰控制方法、装置与电子设备
CN109100939B (zh) 考虑输入饱和的水面无人艇全状态约束轨迹跟踪控制方法
CN110865539A (zh) 一种随机干扰下的无人艇跟踪误差约束控制方法
CN108197350B (zh) 一种无人船速度和不确定性估计系统及设计方法
CN112612209B (zh) 基于指令滤波神经网络控制器的全驱动船舶轨迹跟踪控制方法及系统
Gao et al. Adaptive formation control of autonomous underwater vehicles with model uncertainties
CN110333658B (zh) 一种带输入约束和漂角补偿的欠驱动船舶航向控制方法
CN110687799A (zh) 一种智能船舶自动舵系统的模糊自适应输出反馈控制方法及系统
CN114442640B (zh) 一种水面无人艇轨迹跟踪控制方法
CN113110511B (zh) 一种基于广义模糊双曲模型的智能船舶航向控制方法
CN111930124A (zh) 一种智能船舶自动舵系统的模糊自适应输出反馈有限时间控制方法及系统
CN111381595B (zh) 基于事件触发的船舶动力定位方法
CN113485121A (zh) 一种分布式多船协同动力定位控制方法
CN115167481A (zh) 一种欠驱动无人艇预设性能路径跟踪控制方法及系统
CN110515387A (zh) 一种水面船舶漂角补偿非线性航向控制方法
CN117452827B (zh) 一种欠驱动无人艇轨迹跟踪控制方法
CN113093735B (zh) 随机扰动下输出受限欠驱动无人艇的横截函数控制方法、系统及介质
Zhang et al. Hybrid threshold event-triggered control for sail-assisted USV via the nonlinear modified LVS guidance
CN117519183A (zh) 一种切换无人船动态记忆事件触发模糊动力定位控制方法
CN116088309B (zh) 一种基于故障辨识的水面船复合学习容错控制方法
Wan et al. Fractional order PID motion control based on seeker optimization algorithm for AUV
CN114924571A (zh) 一种具有橫摇约束的欠驱动船舶航向和舵减摇控制方法
Ansari et al. Hybrid direct-indirect adaptive generalized dynamic inversion based attitude control of autonomous underwater vehicles

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