摘要
针对模型不确定、外界环境干扰和输入死区下的欠驱动水面船路径跟踪控制问题, 本文提出一种自适应有限时间路径跟踪控制方法. 首先, 设计有限时间视线制导律生成期望纵向速度和艏向角指令; 继而, 采用反步法分别设计有限时间纵向速度和艏向角控制器跟踪生成的期望信号, 其中结合径向基函数神经网络和最小学习参数算法逼近模型参数不确定性, 以及运用自适应技术补偿环境干扰、神经网络逼近误差和未知死区非线性组成的合成干扰; 此外, 为了避免复杂计算, 运用二阶跟踪微分器得到虚拟艏向控制律的导数, 基于李雅普诺夫稳定性理论, 证明整个闭环系统是实际有限时间稳定的; 最后, 仿真结果验证了所提方案的有效性.
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 上的未知连续函数 f(x):,其可以被RBFNN逼近 [19],即
(1)
式中:表示 RBFNN 的输入向量; 为估计误差,且为正常数; 是RNFNN的最优权值,有为正常数,m表示隐含层神经元的个数; 为RBFNN的基函数,一般为高斯函数,即
(2)
式中ci和bi分别表示第i个高斯函数的中心向量和宽度.
然而,在实际应用中,最优权值W是未知的,需要对其进行估计,这增加了控制器的计算负担,导致学习时间变长. 因此,为了减少学习时间,提出了神经网络最小学习参数方法. 定义正常数通过对φ进行估计可以实现最小学习参数的自适应估计. 定义是φ的估计值,是估计误差.
2.2 定义与引理
引理 1 [20] 对于系统若存在正的连续可微函数V(x)、正实数g1,g2,0 <a1 <1和g3 >0 使得
(3)
那么这个系统是实际有限时间稳定的,对于常数0 <µ <g——,有其调节时间满足
(4)
式中V(0)为V(x)的初始值.
引理 2 [21] 对任意实数xi,i = 1,· · ·,n,以及 0 <b <1,有以下不等式成立:
(5)
引理 3 [22] 对任意正常数和有
(6)
式中κ = 0.278 5.
2.3 船舶数学模型
(7)
(8)
式中: x,y,ψ分别表示船舶在北东坐标下的位置和艏向角; u,v,r分别表示船舶在船体坐标系下的线速度和角速度; mii,i = 1,2,3为船舶的惯性参数; dii,i = 1,2,3为船舶的水动力阻尼系数; δ1,δ2,δ3表示时变海洋环境; τ1和τ2为船舶控制输入.
由于船舶执行机构具有死区非线性,控制输入可表示为 [24]

(9)
式中: i = 1,2; τci为控制输入指令; bli ,bri为执行机构死区的折点.
控制输入可重写为
(10)
式中
(11)
于是,有1,2为未知正常数.
欠驱动水面船的动力学模型可以写为
(12)
2.4 路径跟踪误差动态
如图1所示,船舶跟踪一条参数化路径,在路径上选择一参考点(xp(θ),yp(θ))定义Serret-Frenet(SF)坐标系,θ为路径参数,纵轴Xp沿该点在路径上的切线方向,横轴Yp沿该点的法线方向. 东北坐标系的纵轴与Xp之间的夹角为
(13)
式中:
在SF坐标系中,船舶位置(x,y)与参考点(xp,yp)的跟踪误差为
(14)
式中: xe是前向跟踪误差,ye为横向跟踪误差.
图1路径跟踪几何图示
Fig.1The geometrical illustration of path following
对跟踪误差求导,得到
(15)
式中:是欠驱动水面船的合速度,β = arctan为侧滑角,为期望路径上虚拟参考点的速度.
为了避免侧滑角β在u,v同时为0时存在奇点的情况,定义期望侧滑角为下文设计的期望纵向速度. 跟踪误差动态可写成

(16)
式中:ue = u−ud,ψe = ψ−ψd,ψd 为期望艏向角,且sin(ψd+βd−γp)+cos(ψd + βd − γp).
由于可知 ω是有界的,即存在一正常数d1,有
为了下文的控制方案设计,现提出以下假设:
假设 1 欠驱动水面船的惯性参数和水动力阻尼系数是未知的;
假设 2 环境干扰是有界的,即为未知正常数.
注 1 在实际工程中,欠驱动水面船的惯性参数和水动力阻尼系数随着船舶工况而变化,且由于辨识技术或成本原因而难以精确获得,因此,本文假设惯性参数和水动力阻尼系数未知是合理的. 船舶受到的环境干扰能量是有限的,因此,假设2是合理的.
本文的控制目标: 对于存在输入死区、模型不确定和未知环境干扰的欠驱动水面船,设计有限时间制导律和控制律使得船舶能够跟踪一条期望路径.
3 制导律设计
为了跟踪期望路径以及镇定前向和横向跟踪误差,设计有限时间制导律如下:
(17)
(18)
(19)
式中: k1,k2,k3 为设计的正常数,∆ 为前向距离. siga(·)= | · |asign(·),0 <a <1.
注 2 与文献 [5-9] 中的LOS制导律相比,本文设计的制导律能够同时生成期望纵向速度和艏向角,提高了船舶操纵性能. 与文献 [10] 中的制导律相比,在制导律设计中加入 siga(·)项,提高了制导子系统的收敛速度. 此外,由式(18)可知ud >0,避免了侧滑角的奇异问题.
将制导律(17)–(19)代入式(16),可得

(20)
构造李雅普诺夫函数如下:
(21)
对V1求导,得
(22)
4 控制律设计
本节将结合反步法,最小学习参数法以及自适应技术分别设计有限时间纵向和艏向控制器.
4.1 纵向速度控制器
对纵向速度误差ue求导,根据式(12)可得
(23)
式中
选取李雅普诺夫函数如下:
(24)
对V2求导得
(25)
由于f1是未知的,因此,运用RBFNN对其进行估计,有
(26)
式中:为最优权值; 为估计误差,有为正常数.
此外,为了补偿由环境干扰,神经网络逼近误差和死区非线性组成的合成干扰,定义纵向合成干扰的上界为为其估计值,估计误差为.
根据杨氏不等式可得
(27)
式中
设计纵向速度控制律如下:
(28)
式中: ku,ku1,ϵ1是设计的正常数,0 < a <1,为φ1 的估计值.
设计自适应律为
(29)
(30)
式中γu1,γu2,λ1,λ2,p1,p2为设计的正常数.
构造李雅普诺夫函数如下:
(31)
式中
对V2a求导得
(32)
4.2 艏向控制器
第1步对艏向角跟踪误差ψe求导得
(33)
设计虚拟艏向控制律
(34)
式中: kψ,kψ1为设计的正常数,0 <a <1.
让αr0通过二阶跟踪微分器
(35)
式中: l1,l2,l3为设计参数,为跟踪微分器的状态. 根据文献 [25] 可知,当l1 → +∞时,跟踪误差的估计误差趋于零. 这说明y1 = αr − αr0是有界的,即存在一正常数d2,有
第2步定义艏向角速度跟踪误差为
(36)
对其求导得
(37)
式中
选取李雅普诺夫函数如下:
(38)
对V3求导得
(39)
由于f2是未知的,因此运用RBFNN对其进行估计,得
(40)
式中:为最优权值; 为估计误差,有为正常数.
定义艏向合成干扰的上界为为其估计值,估计误差为.
根据杨氏不等式可得
(41)
式中
设计艏向控制律如下:
(42)
式中: kr,kr1,ϵ2是设计的正常数,0 <a <1,为φ2 的估计值.
设计自适应律为
(43)
(44)
式中γr1,γr2,λ3,λ4,p3,p4为设计的正常数.
构造李雅普诺夫函数如下:
(45)
式中.
对V3a求导得
(46)
5 稳定性分析
定理 1 对于欠驱动水面船数学模型(7)–(8),在满足假设1–2的条件下,由设计的制导律(17)–(19)、控制律(28)(42)和更新律(29)(30)(43)(44)组成的制导和控制系统能够实现本文的控制目标,且闭环系统是实际有限时间稳定的.
证选取如下的李雅普诺夫函数:
(47)
对V 求导得
(48)
根据杨氏不等式,有
(49)
(50)
(51)
(52)
(53)
(54)
(55)
(56)
将式(50)–(56)代入式(48),可得
(57)
式中: {}, {},.
通过选取合适的参数,使得K1 >0,K2 >0,根据引理1可知,系统是实际有限时间稳定的. 在有限的时间T 内,对于和0 <µ <K1,V 将收敛到区域且其调节时间T为
(58)
式中V (0)为V 的初值. 证毕.
6 仿真研究
为验证本文设计方法的有效性,以文献 [26] 的船舶模型进行仿真研究. 船舶模型参数为: m11 = 25.8 kg,m22 = 33.8 kg,m33 = 2.76 kgm2,d11 = 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.
跟踪的期望路径如下:
(59)
船舶初始状态设为以及[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
图7D1和D2的估计值
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 结论
本文提出了一种神经自适应有限时间路径跟踪控制方法,解决了欠驱动水面船在输入死区约束下的路径跟踪问题. 在制导子系统中,设计的有限时间视线制导律能够同时制导纵向速度和艏向角. 在控制器设计中,结合径向基神经网络和最小学习参数算法以及自适应技术补偿环境干扰、模型参数不确定以及未知死区非线性,并运用反步法设计有限时间控制器. 通过稳定性分析证明了系统是实际有限时间稳定的,仿真结果也说明了控制方案的有效性. 然而,本文没有考虑输出受限问题,且船舶速度是已知的,后续可进一步研究在速度未知情况下船舶路径跟踪输出受限问题,提高欠驱动水面船路径跟踪性能并保障航行安全.