带有输入死区的欠驱动水面船有限时间路径跟踪控制
doi: 10.7641/CTA.2024.30443
王元慧 , 王心玮 , 邵兴超 , 任哲达
哈尔滨工程大学智能科学与工程学院, 黑龙江 哈尔滨 150001
基金项目: 国家自然科学基金项目(51879049), 黑龙江省自然科学基金项目(LH2019E039)资助.
Finite-time path following control for underactuated surface vessels with input dead-zone
WANG Yuan-hui , WANG Xin-wei , SHAO Xin-chao , REN Zhe-da
College of Intelligent Systems Science and Engineering, Harbin Engineering University, Harbin Heilongjiang 150001 , China
Funds: Supported by the National Natural Science Foundation of China (51879049) and the Natural Science Foundation of Heilongjiang Province (LH2019E039).
摘要
针对模型不确定、外界环境干扰和输入死区下的欠驱动水面船路径跟踪控制问题, 本文提出一种自适应有限时间路径跟踪控制方法. 首先, 设计有限时间视线制导律生成期望纵向速度和艏向角指令; 继而, 采用反步法分别设计有限时间纵向速度和艏向角控制器跟踪生成的期望信号, 其中结合径向基函数神经网络和最小学习参数算法逼近模型参数不确定性, 以及运用自适应技术补偿环境干扰、神经网络逼近误差和未知死区非线性组成的合成干扰; 此外, 为了避免复杂计算, 运用二阶跟踪微分器得到虚拟艏向控制律的导数, 基于李雅普诺夫稳定性理论, 证明整个闭环系统是实际有限时间稳定的; 最后, 仿真结果验证了所提方案的有效性.
Abstract
This paper presents an adaptive finite-time path following control scheme for underactuated surface vessels in the presence of input dead-zone, model uncertainties and external environmental disturbances. Firstly, a finite-time surge-heading line-of-sight guidance law is designed to generate desired surge velocity and heading angle. Then, the adaptive finite-time surge and the heading controllers are developed to track reference signals via backstepping technique, where radial basis function neural network and minimum learning parameter algorithm are applied to approximate model uncertainties, and the adaptive technique is introduced to offset the lumped disturbances including unknown external environmental disturbances, approximation errors and input dead-zone. Besides, to reduce the computational burden inherent in backstepping technique, a second-order tracking differentiator is employed to generate derivative of the virtual heading control law. Based on the Lyapunov functions, it is proved that the closed-loop system is practical finite-time stable. Finally, simulation results are given to demonstrate the efficacy of the proposed scheme.
1 引言
随着欠驱动水面船在海事工程的广泛应用,欠驱动水面船的路径跟踪控制受到很多学者关注 [1-4] . 欠驱动水面船路径跟踪是指在不考虑时间约束的条件下,设计一个控制方案使得船舶能够到达期望路径并沿路径航行 [5] . 欠驱动水面船仅由螺旋桨和舵来控制其在水平面的运动,而没有横向推进器,容易受到海洋环境的影响,影响跟踪性能. 因此,欠驱动水面船路径跟踪控制研究具有重要的理论与工程意义.
路径跟踪控制可分成制导子系统和控制子系统,前者生成期望信号,后者跟踪生成的参考信号. 视线(line-of-sight,LOS)制导方法由于简单有效而广泛应用在欠驱动水面船路径跟踪控制中. 文献 [6] 基于 LOS制导律设计期望艏向角,进而设计滑模控制器,保证了路径跟踪性能. 文献 [7] 在传统LOS制导律中加入积分项,用于减少横向跟踪误差,改进跟踪效果. 文献 [8] 提出了一种基于预测器的LOS制导律,对外界干扰引起的侧滑角进行补偿. 文献 [9] 将滑模技术和LOS 制导律结合,设计了鲁棒LOS制导律,提高了系统的鲁棒性. 文献 [10] 设计了速度变化LOS制导律,同时,生成期望纵向速度和艏向角,提高了船舶的操纵性能.
在控制子系统中,外界环境干扰和模型不确定性会对船舶运动造成不利影响,需要在控制设计中进行处理. 文献 [11] 采用降阶扩张状态观测器对环境干扰进行估计,然后基于反步法设计路径跟踪控制器. 此外,神经网络具有万能逼近特性,常被用来处理船舶的不确定和环境干扰问题. 文献 [12] 应用回声状态神经网络来估计模型不确定性. 文献 [13] 运用径向基神经网络(radial basis function neural network,RBFNN)补偿系统的不确定性和环境干扰. 文献 [14] 设计了一种自适应神经网络控制器,应用RBFNN逼近由模型不确定、环境干扰和输入饱和建模误差组成的合成干扰. 然而,上述方法需要在线调整神经网络权值矩阵,导致学习时间变长. 因此,文献 [15] 结合最小学习参数和神经网络来补偿系统的未知动态. 此外,上述文献仅能证明在时间趋于无穷时系统是稳定的. 为了提高系统的收敛速度,文献 [16] 基于反步法设计了自适应模糊有限时间控制器,并证明了系统是实际有限时间稳定的. 文献 [17] 针对水面船轨迹跟踪问题设计了有限时间反步控制器,并运用有限时间干扰观测器估计外界干扰. 然而,上述文献都未考虑输入死区问题. 大多数物理系统都存在输入死区特性,特别是在船舶的执行机构中. 在控制器设计过程中忽视死区问题会降低跟踪性能,甚至导致系统不稳定 [18] .
受上述文献启发,本文研究具有输入死区特性的欠驱动水面船路径跟踪控制问题. 在制导子系统中设计有限时间视线制导律生成期望信号,继而在控制子系统运用反步法设计有限时间控制器. 结合神经网络技术和最小学习参数算法以及自适应技术处理系统的不确定项、环境干扰与死区非线性效果. 本文的主要贡献如下:
1)提出了一种有限时间视线制导律,能够生成纵向速度和艏向角期望信号,提高了跟踪性能和收敛速度;
2)设计了自适应有限时间路径跟踪控制器,对输入死区进行补偿,证明了整个系统是实际有限时间稳定的;
3)结合神经网络技术和最小学习参数算法对模型不确定性进行逼近,与传统的神经网络技术相比,设计参数显著减少,更容易应用于工程实际. 并运用自适应技术补偿由环境干扰,逼近误差和死区非线性组成的合成干扰.
2 预备知识与问题描述
2.1 神经网络最小学习参数法
对于定义在紧集x 上的未知连续函数 fx):RnR,其可以被RBFNN逼近 [19],即
f(x)=WTh(x)+χ,
(1)
式中:xΩx表示 RBFNN 的输入向量; χ为估计误差,且|χ|χ*χ*为正常数; W=w1 w2 wmTRm是RNFNN的最优权值,有WW*W*为正常数,m表示隐含层神经元的个数; hx=h1x h2x hmxT为RBFNN的基函数,一般为高斯函数,即
hi(x)=exp-x-ci22bi2,i=1,2,,m,
(2)
式中cibi分别表示第i个高斯函数的中心向量和宽度.
然而,在实际应用中,最优权值W是未知的,需要对其进行估计,这增加了控制器的计算负担,导致学习时间变长. 因此,为了减少学习时间,提出了神经网络最小学习参数方法. 定义正常数φ=W2通过对φ进行估计可以实现最小学习参数的自适应估计. 定义φ^φ的估计值,φ~=φ^-φ是估计误差.
2.2 定义与引理
引理 1 [20] 对于系统x˙=fx若存在正的连续可微函数Vx)、正实数g1g2,0 <a1 <1和g3 >0 使得
V˙(x)-g1V(x)-g2Va1(x)+g3,
(3)
那么这个系统是实际有限时间稳定的,对于常数0 <µ <g——,有Vxg3g1-μ其调节时间满足
T1μ1-a1lnμV1-a1(0)+g2g2,
(4)
式中V(0)为Vx)的初始值.
引理 2 [21] 对任意实数xii = 1,· · ·,n,以及 0 <b <1,有以下不等式成立:
x1++xnbx1b++xnb.
(5)
引理 3 [22] 对任意正常数ϵxR
0|x|-xtanhxϵκϵ,
(6)
式中κ = 0.278 5.
2.3 船舶数学模型
x ˙ = u cos ψ v sin ψ , y ˙ = u sin ψ + v cos ψ , ψ ˙ = r ,
(7)
m 11 u ˙ = m 22 v r d 11 u + δ 1 + τ 1 , m 22 v ˙ = m 11 u r d 22 v + δ 2 , m 33 r ˙ = m 11 m 22 u v d 33 r + δ 3 + τ 2 ,
(8)
式中: xyψ分别表示船舶在北东坐标下的位置和艏向角; uvr分别表示船舶在船体坐标系下的线速度和角速度; miii = 1,2,3为船舶的惯性参数; diii = 1,2,3为船舶的水动力阻尼系数; δ1δ2δ3表示时变海洋环境; τ1τ2为船舶控制输入.
由于船舶执行机构具有死区非线性,控制输入可表示为 [24]
(9)
式中: i = 1,2; τci为控制输入指令; bli bri为执行机构死区的折点.
控制输入可重写为
τi=τci+ρi,i=1,2
(10)
式中
ρ i = b r i , τ c i b r i , τ c i , b 1 i τ c i < b r i , i = 1 , 2 , b l i , τ c i < b l i ,
(11)
于是,有ρiρ-i=maxbri-b1ii=1,2; ρ-ii=1,2为未知正常数.
欠驱动水面船的动力学模型可以写为
m 11 u ˙ = m 22 v r d 11 u + δ 1 + ρ 1 + τ c 1 , m 22 v ˙ = m 11 u r d 22 v + δ 2 , m 33 r ˙ = m 11 m 22 u v d 33 r + δ 3 + ρ 2 + τ c 2 .
(12)
2.4 路径跟踪误差动态
图1所示,船舶跟踪一条参数化路径,在路径上选择一参考点(xpθ),ypθ))定义Serret-Frenet(SF)坐标系,θ为路径参数,纵轴Xp沿该点在路径上的切线方向,横轴Yp沿该点的法线方向. 东北坐标系的纵轴与Xp之间的夹角为
γp=arctanyp'(θ)xp'(θ),
(13)
式中:xp'θ=xpθyp'θ=ypθ.
在SF坐标系中,船舶位置(xy)与参考点(xpyp)的跟踪误差为
xeye=cosγp -sinγpsinγp cosγpTx-xpy-yp,
(14)
式中: xe是前向跟踪误差,ye为横向跟踪误差.
1路径跟踪几何图示
Fig.1The geometrical illustration of path following
对跟踪误差求导,得到
x˙e=Ucosψ-γp+β+γ˙pye-ux,y˙e=Usinψ-γp+β-γ˙pxe,
(15)
式中:U=u2+v2是欠驱动水面船的合速度,β = arctanvu为侧滑角,ux=θ˙xp'2θ+yp'2θ为期望路径上虚拟参考点的速度.
为了避免侧滑角βuv同时为0时存在奇点的情况,定义期望侧滑角βd=arctanvudud为下文设计的期望纵向速度. 跟踪误差动态可写成
(16)
式中:Ud=ud2+v2ue = uudψe = ψψdψd 为期望艏向角,且ω=cosψe-1ψesin(ψd+βdγp)+sinψeψecos(ψd + βdγp).
由于cosψe-1ψe<0.73sinψeψe1可知 ω是有界的,即存在一正常数d1,有|ω|d1.
为了下文的控制方案设计,现提出以下假设:
假设 1 欠驱动水面船的惯性参数和水动力阻尼系数是未知的;
假设 2 环境干扰δii=1,23是有界的,即δiδ-iδ-ii=1,23为未知正常数.
注 1 在实际工程中,欠驱动水面船的惯性参数和水动力阻尼系数随着船舶工况而变化,且由于辨识技术或成本原因而难以精确获得,因此,本文假设惯性参数和水动力阻尼系数未知是合理的. 船舶受到的环境干扰能量是有限的,因此,假设2是合理的.
本文的控制目标: 对于存在输入死区、模型不确定和未知环境干扰的欠驱动水面船,设计有限时间制导律和控制律使得船舶能够跟踪一条期望路径.
3 制导律设计
为了跟踪期望路径以及镇定前向和横向跟踪误差,设计有限时间制导律如下:
ux=k1xe+k2sigaxe+Udcosψ+βd-γp,
(17)
ud=k3ye+sigaye2+Δ2
(18)
ψd=γp-βd-arctanye+sigayeΔ,
(19)
式中: k1k2k3 为设计的正常数, 为前向距离. siga(·)= | · |asign(·),0 <a <1.
注 2 与文献 [5-9] 中的LOS制导律相比,本文设计的制导律能够同时生成期望纵向速度和艏向角,提高了船舶操纵性能. 与文献 [10] 中的制导律相比,在制导律设计中加入 siga(·)项,提高了制导子系统的收敛速度. 此外,由式(18)可知ud >0,避免了侧滑角的奇异问题.
将制导律(17)–(19)代入式(16),可得
(20)
构造李雅普诺夫函数如下:
V1=12xe2+12ye2.
(21)
V1求导,得
V˙1=xex˙e+yey˙e=-k1xe2-k2xesigaxe-k3cosβdye2-k3cosβdyesigaye+xeuecosψ-γp+yeuesinψd-γp+Uωyeψe-k1xe2-k3ye2-k2xe1+a-k3ye1+a+xeuecosψ-γp+yeuesinψd-γp+Uωyeψe.
(22)
4 控制律设计
本节将结合反步法,最小学习参数法以及自适应技术分别设计有限时间纵向和艏向控制器.
4.1 纵向速度控制器
对纵向速度误差ue求导,根据式(12)可得
m11u˙e=m22vr-d11u+δ1+ρ1+τc1-m11u˙d=f1+δ1+ρ1+τc1,
(23)
式中f1=m22vr-d11u-m11u˙d.
选取李雅普诺夫函数如下:
V2=m112ue2
(24)
V2求导得
V˙2=m11ueu˙e=uef1+δ1+ρ1+τc1
(25)
由于f1是未知的,因此,运用RBFNN对其进行估计,有
f1=W1Thx1+χ1,
(26)
式中:W1为最优权值; x1=u v r u˙d; χ1为估计误差,有χ1χ1*χ1*为正常数.
此外,为了补偿由环境干扰,神经网络逼近误差和死区非线性组成的合成干扰,定义纵向合成干扰的上界为D1=δ-1+ρ-1+χ1*D^1为其估计值,估计误差为D~1=D^1-D1.
根据杨氏不等式可得
ueW1Thx112ue2φ1hTx1hx1+12,
(27)
式中φ1=W12.
设计纵向速度控制律如下:
τc1=-kuue-ku1sigaue-12ueφ^1hTx1hx1-tanhueϵ1D^1,
(28)
式中: kuku1ϵ1是设计的正常数,0 < a <1,φ^1φ1 的估计值.
设计自适应律为
φ^˙1=12γu1ue2hTx1hx1-γu1λ1φ^1-p1,
(29)
D^˙1=γu2uetanhueϵ1-γu2λ2D^1-p2
(30)
式中γu1γu2λ1λ2p1p2为设计的正常数.
构造李雅普诺夫函数如下:
V2a=m112ue2+12γu1φ~12+12γu2D~12,
(31)
式中φ~1=φ^1-φ1.
V2a求导得
V˙2a=m11ueu˙e+1γu1φ~1φ^˙1+1γu2D~1D^˙1=ueW1Thx1+χ1+δ1+ρ1+τc1+12ue2φ~1hTx1hx1-λ1φ~1φ^1-p1+ueD~1tanhueϵ1-λ2D~1D^1-p2-kuue2-ku1ue1+a-λ1φ~1φ^1-p1-λ2D~1D^1-p2+D1ϵ1κ+12
(32)
4.2 艏向控制器
第1步对艏向角跟踪误差ψe求导得
ψ˙e=r-ψ˙d
(33)
设计虚拟艏向控制律
αr0=-kψψe-kψ1sigaψe+ψ˙d
(34)
式中: kψkψ1为设计的正常数,0 <a <1.
αr0通过二阶跟踪微分器
α ˙ r = p p ˙ = l 1 2 l 2 α r α r 0 + l 3 p l 1 ,
(35)
式中: l1l2l3为设计参数,p=α˙r为跟踪微分器的状态. 根据文献 [25] 可知,当l1 → +∞时,跟踪误差的估计误差趋于零. 这说明y1 = αrαr0是有界的,即存在一正常数d2,有y1d2.
第2步定义艏向角速度跟踪误差为
re=r-αr,
(36)
对其求导得
m33r˙e=m11-m22uv-d33r+δ3+ρ2+τc2-m33α˙r=f2+δ3+ρ2+τc2,
(37)
式中f2=m11-m22uv-d33r-m33α˙r.
选取李雅普诺夫函数如下:
V3=12ψe2+m332re2
(38)
V3求导得
V˙3=ψeψ˙e+m33rer˙e=ψeψ˙e+ref2+δ3+ρ2+τc2
(39)
由于f2是未知的,因此运用RBFNN对其进行估计,得
f2=W2Thx2+χ2,
(40)
式中:W2为最优权值; x2=u v r r˙d; χ2为估计误差,有χ2χ2*χ2*为正常数.
定义艏向合成干扰的上界为D2=δ-3+ρ-2+χ2*D^2为其估计值,估计误差为D~2=D^2-D2.
根据杨氏不等式可得
reW2Thx212re2φ2hTx2hx2+12,
(41)
式中φ2=W22.
设计艏向控制律如下:
τc2=-krre-kr1sigare-ψe-12reφ^2hTx2hx2-tanhreϵ2D^2,
(42)
式中: krkr1ϵ2是设计的正常数,0 <a <1,φ^2φ2 的估计值.
设计自适应律为
φ^˙2=12γr1re2hTx2hx2-γr1λ3φ^2-p3,
(43)
D^˙2=γr2retanhreϵ2-γr2λ4D^2-p4
(44)
式中γr1γr2λ3λ4p3p4为设计的正常数.
构造李雅普诺夫函数如下:
V3a=12ψe2+m332re2+12γr1φ~22+12γr2D~22,
(45)
式中φ~2=φ^2-φ2.
V3a求导得
V˙3a=ψeψ˙e+m33rer˙e+1γr1φ~2φ^˙2+1γr2D~2D^˙2=ψere+y1+αr0-ψ˙d+reW2Thx2+χ2+δ3+ρ2+τc2+12re2φ~1hx2hx2-λ3φ~2φ^2-p3+reD~2tanhreϵ2-λ4D~2D^2-p4-kψψe2-kψ1ψe1+a-krre2-kr1re1+a-λ3φ~2φ^2-p3-λ4D~2D^2-p4+12+ψey1+D2ϵ2κ
(46)
5 稳定性分析
定理 1 对于欠驱动水面船数学模型(7)–(8),在满足假设1–2的条件下,由设计的制导律(17)–(19)、控制律(28)(42)和更新律(29)(30)(43)(44)组成的制导和控制系统能够实现本文的控制目标,且闭环系统是实际有限时间稳定的.
选取如下的李雅普诺夫函数:
V=V1+V2a+V3a=12xe2+12ye2+m112ue2+12γu1φ~12+12γu2D~12+12ψe2+m332re2+12γr1φ~22+12γr2D~22
(47)
V 求导得
V˙-k1xe2-k3ye2-k2xe1+a-k3ye1+a+xeuecosψ-γp+yeuesinψd-γp+Uωyeψe-kuue2-ku1ue1+a-λ1φ~1φ^1-p1-λ2D~1D^1-p2+D1ϵ1κ+12-kψψe2-kψ1ψe1+a-krre2-kr1re1+a-λ3φ~2φ^2-p3-λ4D~2D^2-p4+12+ψey1+D2ϵ2κ
(48)
根据杨氏不等式,有
xeuecosψ-γp12xe2+12ue2,
(49)
yeuesinψd-γp12ye2+12ue2
(50)
Uωyeψe12ye2+12U2d12ψe2,
(51)
-φ~1φ^1-p1-12φ~12+12φ1-p12=-14φ~12-14φ~1-φ~12+14φ~1-12φ~132+12φ1-p12-18φ~12-12φ~132+12φ1-p12
(52)
-φ~2φ^2-p3-18φ~22-12φ~232+12φ2-p32,
(53)
-D~1D^1-p2-18D~12-12D~132+12D1-p22
(54)
-D~2D^2-p4-18D~22-12D~232+12D2-p42
(55)
ψey112ψe2+12d22
(56)
将式(50)–(56)代入式(48),可得
V˙-k1xe2-k3ye2-k2xe1+a-k3ye1+a+12xe2+ue2+12ye2+12U2d12ψe2+12ye2-kuue2-ku1ue1+a-λ18φ~12-λ12φ~132+λ12φ1-p12-λ28D~12-λ22D~132+λ22D1-p22+D1ϵ1κ+12-kψψe2-kψ1ψe1+a-krre2-kr1re1+a-λ38φ~22-λ32φ~232+λ32φ2-p32-
λ48D~22-λ42D~232+λ42D2-p42+D2ϵ2κ+12+12ψe2+12d22-k1-12xe2-k3-1ye2-ku-1ue2-λ18φ~12-λ28D~12-kψ-12U2d12-12ψe2-krre2-λ38φ~22-λ48D~22-k2xe21+a2-k3ye21+a2-ku1ue21+a2-λ12φ~1234-λ22D~1234-kψ1ψe21+a2-kr1re21+a2-λ32φ~2234-λ42D~2234+λ12φ1-p12+λ22D1-p22+λ32φ2-p32+D1ϵ1κ+λ42D2-p42+12d22+D2ϵ2κ+1-K1V-K2Vg+C,
(57)
式中: K1=min{2k1-122k3-12ku-1λ1γu14λ2γu242kψ-12U2d12-122krλ3γr14λ4γr14},K2=min {21+a2k221+a2k321+a2ku12-14λ1γu1342-14λ2γu23421+a2kψ121+a2kr12-14λ3γr1342-14λ3γr234},g=min1+a234C=λ12φ1-p12+λ22D1-p22+λ32φ2-p32+λ42D2-p42+12d22+D1ϵ1κ+D2ϵ2κ+1.
通过选取合适的参数,使得K1 >0,K2 >0,根据引理1可知,系统是实际有限时间稳定的. 在有限的时间T 内,对于tT和0 <µ <K1V 将收敛到区域V2CK1-μ且其调节时间T
T=1μ(1-g)lnμV1-g(0)+K2K2,
(58)
式中V (0)为V 的初值. 证毕.
6 仿真研究
为验证本文设计方法的有效性,以文献 [26] 的船舶模型进行仿真研究. 船舶模型参数为: m11 = 25.8 kg,m22 = 33.8 kg,m33 = 2.76 kgm2d11 = 0.93 kg/s,d22 = 2.89 kg/s,d33 = 0.5 kg · m2 /s. 船舶执行机构的死区参数为: br1 = br2 = 1,bl1 = bl2 = − 1. 时变环境干扰设置为: δ1 = 0.7 × sin(0.1t)+ 0.3 sin(0.2t)+ 0.4,δ2 = 0.4 cos(0.5t + 0.1π)+ 0.1 sin(0.2t)+ 0.1,δ3 = 0.4 cos(0.5t + 0.2π)+ 0.2 sin(0.1t)+ 0.2.
跟踪的期望路径如下:
x p ( θ ) = 5 sin ( 0.2 θ ) + θ , y p ( θ ) = θ .
(59)
船舶初始状态设为x y ψT=4 0 π4T以及[u v r] T =[0 0 0]T. 控制参数设置为: k1 = 1,k2 = 1,k3 = 0.2,= 1,a = 0.8,ku = 10,ku1 = 1,kψ = 1,kψ1 = 0.1,kr = 10,kr1 = 1,γu1 = 5,λ1 = 0.2,p1 = 10,γu2 = 20,ϵ1 = 0.05,λ2 = 0.01,p2 = 100,γr1 = 5,λ3 = 0.2,p3 = 10,γr2 = 5,ϵ2 = 0.05,λ4 = 0.01,p4 = 100, l1 = 10,l2 = 1,l3 = 1.
为了验证本文方法的有效性,将进行2组仿真对比. 第1组,在考虑输入死区的情况下,将本文设计的有限时间视线制导律与文献 [9] 中的鲁棒视线制导律以及文献 [10] 中的纵向速度变化视线制导律进行对比; 第2组,将进行死区补偿与不考虑输入死区的情况进行对比.
6.1 制导律性能验证
为了验证本文提出的有限时间视线制导律的有效性,将其与文献 [9] 中的鲁棒视线制导律以及文献 [10] 中的纵向速度变化视线制导律进行对比,本文制导律与文献 [9-10] 中的制导律分别定义为有限时间纵向速度和艏向角(finite-time surge-heading LOS,FTSHLOS)制导律、鲁棒视线(robust LOS,RLOS)制导律和纵向速度变化视线(surge varying LOS,SVLOS)制导律,仿真结果如图2–9所示.
图2可知,在各个制导律下,欠驱动水面船均能到达期望路径,并沿路径航行.
2不同制导律下的路径跟踪效果
Fig.2Path following performance under different guidance laws
图3可以看出,基于FTSHLOS制导律的船舶跟踪误差有着更好的稳态性能,船舶能更快到达期望路径,这是因为本文设计了有限时间制导律,船舶跟踪误差收敛速度比RLOS和SVLOS快.
3不同制导律下的路径跟踪误差
Fig.3Path following errors under different guidance laws
图4–5分别是欠驱动水面船的艏向角和纵向速度跟踪曲线,可以看出其跟踪效果良好.
图6–7分别是纵向和艏向上神经网络权值范数平方以及合成干扰的估计值,表明这些参数总是有界的,且在输入死区存在的情况下实现稳定.
4不同制导律下的艏向角跟踪
Fig.4The heading angle tracking performance under different guidance laws
5不同制导律下的纵向速度跟踪
Fig.5The surge speed tracking performance under different guidance laws
6φ1φ2的估计值
Fig.6The estimations of φ1 and φ2
7D1D2的估计值
Fig.7The estimations of D1 and D2
图8为欠驱动水面船的实际控制输入.
基于以上结果,可以得出本文设计的有限时间制导律使得船舶在一定时间内跟踪上期望路径,且跟踪误差波动范围小.
8不同制导律下的控制输入
Fig.8The control inputs under different guidance laws
6.2 控制器性能验证
为了验证本文设计控制器对死区非线性进行处理的有效性,将其与文献 [17] 中不考虑输入死区情况下设计的控制器进行对比,本文控制器与文献 [17] 中的控制器分别定义为考虑死区与未考虑死区. 仿真结果如图9–12所示.
图9可知,在两种控制方法下,欠驱动水面船均能跟踪期望路径.
9不同控制器下的路径跟踪效果
Fig.9Path following performance under different controllers
图10可以看出,本文控制器有着更好的稳态性能,而忽视死区导致横向跟踪误差存在波动.
图11给出了欠驱动水面船的艏向角和纵向速度误差变化曲线,明显看出死区非线性对跟踪性能造成的不利影响. 在忽视输入死区的情况下,设计的控制命令没有超出死区界限,导致船舶控制输入为0,因此,纵向速度和艏向角不能及时跟踪期望值,跟踪误差波动较大.
图12是欠驱动水面船的实际控制输入,可以看出在不考虑输入死区情况下设计的控制器所得到的控制输入在一些时刻为0,这会影响船舶的路径跟踪性能,导致较大的路径跟踪误差. 从仿真结果可以得出,本文对死区非线性进行补偿所设计的控制方案更符合实际情况,且有着更好的跟踪性能.
10不同控制器下的路径跟踪误差
Fig.10Path following errors under different controllers
11不同控制器下的艏向角和纵向速度跟踪误差
Fig.11Heading angle and surge velocity tracking errors under different controllers
12不同控制器下的控制输入
Fig.12The control inputs under different controllers
7 结论
本文提出了一种神经自适应有限时间路径跟踪控制方法,解决了欠驱动水面船在输入死区约束下的路径跟踪问题. 在制导子系统中,设计的有限时间视线制导律能够同时制导纵向速度和艏向角. 在控制器设计中,结合径向基神经网络和最小学习参数算法以及自适应技术补偿环境干扰、模型参数不确定以及未知死区非线性,并运用反步法设计有限时间控制器. 通过稳定性分析证明了系统是实际有限时间稳定的,仿真结果也说明了控制方案的有效性. 然而,本文没有考虑输出受限问题,且船舶速度是已知的,后续可进一步研究在速度未知情况下船舶路径跟踪输出受限问题,提高欠驱动水面船路径跟踪性能并保障航行安全.
1路径跟踪几何图示
Fig.1The geometrical illustration of path following
2不同制导律下的路径跟踪效果
Fig.2Path following performance under different guidance laws
3不同制导律下的路径跟踪误差
Fig.3Path following errors under different guidance laws
4不同制导律下的艏向角跟踪
Fig.4The heading angle tracking performance under different guidance laws
5不同制导律下的纵向速度跟踪
Fig.5The surge speed tracking performance under different guidance laws
6φ1φ2的估计值
Fig.6The estimations of φ1 and φ2
7D1D2的估计值
Fig.7The estimations of D1 and D2
8不同制导律下的控制输入
Fig.8The control inputs under different guidance laws
9不同控制器下的路径跟踪效果
Fig.9Path following performance under different controllers
10不同控制器下的路径跟踪误差
Fig.10Path following errors under different controllers
11不同控制器下的艏向角和纵向速度跟踪误差
Fig.11Heading angle and surge velocity tracking errors under different controllers
12不同控制器下的控制输入
Fig.12The control inputs under different controllers
ZHENG Z W, FEROSKHAN M. Path following of a surface vessel with prescribed performance in the presence of input saturation and external disturbances. IEEE/ASME Transactions on Mechatronics,2017,22(6):2564-2575.
HU C, WANG R R, YAN F J,et al. Robust composite nonlinear feedback path-following control for underactuated surface vessels with desired-heading amendment. IEEE Transactions on Industrial Electronics,2016,63(10):6386-6394.
WANG Shandan, SUN Mengwei, LIU Jian,et al. Fixed-time predictor-based path following control of unmanned surface vehicles. Control Theory & Applications,2022,39(10):1845-1853.(王山丹, 孙梦薇, 刘剑, 等. 固定时间预测器下的欠驱动无人艇路径跟踪控制. 控制理论与应用,2022,39(10):1845-1853.)
GU N, WANG D, PENG Z H,et al. Advances in line-of-sight guidance for path following of autonomous marine vehicles: An overview. IEEE Transactions on Systems, Man,and Cybernetics: Systems,2023,53(1):12-28.
FOSSEN T I, LEKKAS A M. Direct and indirect adaptive integral line-of-sight path-following controllers for marine craft exposed to ocean currents. International Journal of Adaptive Control and Signal Processing,2017,31(4):445-463.
FOSSEN T I, PETTERSEN K Y. On uniform semiglobal exponential stability(USGES)of proportional line-of-sight guidance laws. Automatica,2014,50(11):2912-2917.
LEKKAS A M, FOSSEN T I. Integral LOS path following for curved paths based on a monotone cubic Hermite spline parametrization. IEEE Transactions on Control Systems Technology,2014,22(6):2287-2301.
QIU B B, WANG G F, FAN Y S. Predictor LOS-based trajectory linearization control for path following control of underactuated unmanned surface vehicle with input saturation. Ocean Engineering,2020,214:1-12.
LIU C, GUO W L, SUN T. RLOS-based path following with eventtriggered roll motion control for underactuated ship using rudder. Ocean Engineering,2023,269:1-6.
WANG N, SUN Z, SU S F,et al. Fuzzy uncertainty observer-based path-following control of underactuated marine vehicles with unmodeled dynamics and disturbances. International Journal of Fuzzy Systems,2018,20(8):2593-2604.
MIAO J M, WANG S P, TOMOVIC M M,et al. Compound line-ofsight nonlinear path following control of underactuated marine vehi-cles exposed to wind,waves,and ocean currents. Nonlinear Dynamics,2017,89(4):2441-2459.
DENG Y J, ZHANG X K, ZHANG G Q. Line-of-sight-based guidance and adaptive neural path-following control for sailboats. IEEE Journal of Oceanic Engineering,2020,45(4):1177-1189.
WANG Yuanhui, WANG Haibin, ZHANG Xiaoyun. Robust adaptive fault-tolerant tracking control for dynamic positioning vessel. Control Theory & Applications,2021,38(2):287-300.(王元慧, 王海滨, 张晓云. 动力定位船轨迹跟踪鲁棒自适应容错控制. 控制理论与应用,2021,38(2):287-300.)
XIA G Q, WANG X W, ZHAO B,et al. ESHLOS guidance for neuroadaptive path following control of underactuated surface vessels. Ocean Engineering,2022,266(3):1-10.
SHEN Z P, BI Y N, WANG Y,et al. MLP neural network-based recursive sliding mode dynamic surface control for trajectory tracking of fully actuated surface vessel subject to unknown dynamics and input saturation. Neurocomputing,2020,377:103-112.
NEI J, LING X G. FAILOS guidance law based adaptive fuzzy finitetime path following control for underactuated MSV. Ocean Engineering,2020,195:1-13.
VAN M, DO V T, KHYAM M O,et al. Tracking control of uncertain surface vessels with global finite-time convergence. Ocean Engineering,2021,241:1-10.
CHEN M, CHEN S D, WU Q X. Sliding mode disturbance observerbased adaptive control for uncertain MIMO nonlinear systems with dead-zone. International Journal of Adaptive Control and Signal Processing,2017,31(7):1003-1018.
ZHU G B, MA Y, LI Z X,et al. Adaptive neural output feedback control for MSVs with predefined performance. IEEE Transactions on Vehicular Technology,2021,70(4):2994-3006.
CHEN B, LIN C. Finite-time stabilization-based adaptive fuzzy control design. IEEE Transactions on Fuzzy Systems,2021,29(8):2438-2443.
ZHU G B, MA Y, HU S L. Single-parameter-learning-based finitetime tracking control of underactuated MSVs under input saturation. Control Engineering Practice,2020,105:732-745.
DU J L, HU X, SUN Y Q. Adaptive robust nonlinear control design for course tracking of ships subject to external disturbances and input saturation. IEEE Transactions on Systems, Man,and Cybernetics: Systems,2020,50(1):193-202.
FOSSEN T I. Handbook of Marine Craft Hydrodynamics and Motion Control.2nd ed. Hoboken, NJ, USA: Wiley,2021.
SUN Guofa, HENG Lifan. Active disturbance rejection dynamic surface control of high-order nonlinear system with dead-zone. Control Theory & Applications,2019,36(8):1336-1344.(孙国法, 衡丽帆. 含死区高阶非线性系统自抗扰动态面控制. 控制理论与应用,2019,36(8):1336-1344.)
WANG X H, CHZN Z Q, YUAN Z Z. Design and analysis for new discrete tracking-differentiators. Applied Mathematics: A Journal of Chinese Universities,2003,18(2):214-222.
FREDRIKSEN E, PETTERSEN K Y. Global κ-exponential waypoint maneuvering of ships: Theory and experiments. Automatica,2006,42:677-687.