无人水面艇(unmanned surface vehicle, USV)是一种无人操作的、具有自主航行能力的水面机器人[1].以无人水面艇为载体, 通过配备传感器系统、通信系统、武器系统等各种不同的功能模块, 可以执行多种任务, 如水质监测、绘制海图、扫雷、反潜、侦查、反恐、搜救等[2].随着海洋科技的快速发展, 无人水面艇得到了包括科研机构、公司、企业以及各国政府越来越广泛的关注.然而, 相比于其他运载工具, 由于其恶劣的海洋环境, 并遭受到风、浪、流等众多不确定外部扰动的影响, 使得无人水面艇的航迹跟踪控制问题更具挑战性[3].
现有的航迹跟踪控制方法常采用模糊逻辑系统[4]、神经网络控制[5]以及模糊神经网络[6]等.上述方法的优势在于不需要被控对象有精确的数学模型, 而且模糊神经网络可以自动在线逼近系统的不确定项, 同时可以逼近外部未知扰动.然而, 自适应逼近算法只能保证系统误差在时间趋于无穷时才能被镇定到零点附近的一个领域里, 并不能实现有限时间精确控制.因此, 上述渐近控制算法收敛速度慢、控制精度低.
考虑到上述渐近控制算法的不足, 为进一步提高无人水面艇系统的控制性能, 文献[7-8]采用加幂积分方法, 提出一种鲁棒自适应有限时间航迹跟踪控制策略, 能够实现航迹的快速跟踪控制.文献[9]针对无人水面艇的航向控制问题, 提出一种基于负齐次度设计的有限时间航向控制策略.上述有限时间控制器的非光滑性, 使得无人水面艇系统具有更强的鲁棒性, 同时极易引起抖振, 而且外界扰动的精确估计并未得到充分考虑.
为强化有限时间收敛性能, 文献[10]提出了一种终端滑模控制方法.通过构造一个非线性滑模面, 使系统误差能在有限时间内被镇定到原点.而传统的滑模控制方法构造的滑模面为一个线性超平面, 仅能实现渐近的控制效果.因此, 终端滑模具有更快的收敛速度, 该方法已广泛应用于飞行器控制[11]、机械手系统[12]等领域.然而, 终端滑模控制方法不可避免地存在奇异性问题.为了解决这一问题, 文献[13]提出非奇异终端滑模控制律, 并将其应用于N自由度机械手系统中.为进一步加快收敛速度, 文献[14]提出了快速终端滑模控制方法, 当系统状态远离平衡点时, 将能以更快的收敛速度趋于滑模面.此外, 文献[15]提出一种新的积分终端滑模控制方法, 并迅速得到了相应推广[16-17].该方法不仅能够实现有限时间控制, 而且具备很强的鲁棒性和很高的控制精度.然而, 鲜有学者将其应用到海洋航行器航迹跟踪控制中.
本文针对复杂扰动环境下的无人水面艇航迹跟踪问题, 采用积分滑模控制方法, 设计有限时间扰动观测器, 提出一种基于有限时间扰动观测器的无人水面艇精确航迹跟踪控制(FDO-ATTC)策略.将该方法应用到无人水面艇航迹跟踪问题中可以解决以下问题: 1) FDO-ATTC策略能在有限时间将误差镇定到零, 克服了传统渐近航迹控制方法仅能在无穷远时间将误差镇定到零或者零邻域的问题, 因此具有更快的收敛速度和更高的控制精度; 2)通过设计扰动观测器, 实现了对未知时变的风浪流等外界干扰的精准观测, 使得控制系统具有更强的鲁棒性, 进一步实现了复杂海况下的无人艇精确航迹跟踪控制问题.最终采用Lyapunov理论, 严格证明了闭环控制系统的有限时间稳定性.
1 预备知识及问题描述 1.1 预备知识考虑如下非线性系统:
(1) |
其中: x=[x1, x2, …, xn]T为系统状态; f(·)为定义在原点附近U0上的非线性函数, U0⊂Rn.
定义1(齐次性)[18] 令V(x):Rn→R为一连续纯量函数, 若对于任意的ε>0, 存在(r1, r2, …, rn)∈Rn, 其中ri>0(i=1, 2, …, n), 使得
则称V(x)关于(r1, r2, …, rn)具有齐次度σ, 其中(r1, r2, …, rn)称为权重.
令f(x)=[f1(x), f2(x), …, fn(x)]T为一向量函数.若对于任意的ε>0, 存在(r1, r2, …, rn)∈Rn, 使得
则称f(x)关于(r1, r2, …, rn)具有齐次度k.
引理1(有限时间稳定)[18] 如果系统(1)渐近稳定, 并且具有负的齐次度, 则系统(1)有限时间稳定.
引理2(快速有限时间稳定)[12, 19] 如果V(x)满足
(2) |
其中α、β、γ为常数, 且α>0、β>0、γ∈(0, 1), 则系统(1)全局有限时间稳定.
引理3(有限时间稳定)[20] 系统
(3) |
有限时间稳定, 其中L和λi(i=0, 1, …, n)均为正常数.
1.2 问题描述如图 1所示, 令η=[x, y, ψ]T表示地球坐标系(OXoYo)下无人艇运动的位置(x, y)以及艏向角(ψ), υ=[u, υ, r]T表示艇体坐标系(AXY)下的线速度(u, v)以及角速度(r).由此可得USV数学模型为
(4) |
其中: τ=[τ1, τ2, τ3]T为控制输入, τδ:=MRT(ψ)δ(t), δ(t)=[δ1, δ2, δ3]T为外界未知扰动, R(ψ)为转置矩阵, 表示为
(5) |
且具有如下性质:
(6) |
其中:
(7) |
m为艇体质量, Iz为转动惯量,
考虑期望的USV数学模型如下:
(8) |
其中: τd=[τd, 1, τd, 2, τd, 3]T为产生期望信号的控制输入, ηd=[xd, yd, ψd]T和υd=[ud, υd, rd]T分别为期望跟踪的位置矢量以及速度矢量.
本文的控制目标是:通过设计一个有限时间控制律τ, 使得系统(4)的实际航迹向量η和速度向量υ能够在有限时间T精确跟踪式(8)期望的状态信号ηd和υd.
2 FDO-ATTC控制策略设计考虑如下坐标变换:
(9) |
其中: ω=[ω1, ω2, ω3]T, ωd=[ωd, 1, ωd, 2, ωd, 3]T, R=R(ψ), Rd=R(ψd).
结合式(4)和(9)的第1式, 并利用性质(6), 可得
(10) |
其中
(11) |
同理, 由式(8)和(9)的第2式可得
(12) |
其中
(13) |
由式(10) ~ (13)可得航迹跟踪误差系统如下:
(14) |
其中
(15) |
ηe=η-ηd:=[ηe, 1, ηe, 2, ηe, 3]T, ωe=ω-ωd:=[ωe, 1, ωe, 2, ωe, 3]T, 二者分别是经过坐标变换后的位置误差和速度误差.
至此, 只需通过设计有限时间控制律τ, 使得式(14)中的误差ηe和ωe分别被镇定到零点.由坐标变换(9)可知, 实际航迹η和速度υ能在有限时间内跟踪上期望信号ηd和υd.
考虑误差系统(14), 设计如下积分滑模面:
(16) |
其中
(17) |
0<β1<1, β2=(2β1)/(1+β1), κ1>0, κ2>0.
假设1 假设外部扰动δ(t)二阶可微, 且满足
(18) |
其中常数Lδ<∞.
结合假设1、式(14) ~ (17), 采用反馈线性化方法和齐次度理论, 设计如下FDO-ATTC控制律:
(19) |
其中扰动观测器z1为
(20) |
这里
定理1(FDO-ATTC) 在控制律(19)和(20)的作用下, 式(14)中的误差ηe、ωe能在有限时间内被镇定到零点, 实际航迹、速度信号也将分别在有限时间内跟踪上期望状态.
证明 证明过程分为两步, 首先证明系统误差状态可在有限时间内收敛于滑模面(16), 然后证明系统误差在到达该滑模面后可在有限时间内被镇定到零.
Step 1:定义如下Lyapunov函数:
(21) |
对其求导可得
(22) |
将控制律(19)、(20)代入式(22)可得
(23) |
下面验证扰动可被精确观测.定义误差变量
(24) |
可得误差状态方程
(25) |
即
(26) |
其中j=1, 2, 3.
由引理3可知, ωe、δ和
(27) |
可得δ-z1=0.结合式(23), 有
(28) |
其中
由引理2可知, 系统误差状态可以在有限时间内到达滑模面(16).
Step 2:当系统误差状态被镇定到滑模面后, s(t)≡0且
(29) |
结合式(14), 有
(30) |
其中j=1, 2, 3.
由引理1可知, 渐近稳定以及负的齐次度可以保证闭环系统(30)有限时间稳定.下面据此进行证明.
1) 渐近稳定.定义如下Lyapunov函数:
(31) |
对V2(ηe, ωe)求导可得
(23) |
当t趋于无穷远时V2(t)是有界的, 即
(33) |
此外, 由
(34) |
注意到, 由式(32)可得
(35) |
结合式(34)和(35), 并由Barbalat引理[21], 有
(36) |
进而由式(30)可得
(37) |
因此ηe, j=0.闭环系统(30)全局渐近稳定.
2) 负齐次度.式(30)可改写为
(38) |
其中
由此可得
(39) |
显然, 闭环系统(30)有负的齐次度σ=(β1-1)/2<0, 相应的权重为(r1, r2)=(1, (1+β1)/2).根据引理1可知, 闭环误差系统(30)有限时间稳定.
注1 当ρ=1时, 控制律(19)退化为如下传统的积分滑模(ISM)控制策略:
(40) |
当不考虑水面艇遭受的扰动δ时, 由式(28)可知, 该控制策略具有渐近收敛的特性.
4 仿真研究为验证控制策略的有效性和优越性, 选取文献[22]的CyberShip Ⅱ无人艇进行仿真研究.
令τd=[4, 3cos2(0.1πt), sin2(0.1πt)]T, USV初始状态为ηd(0)=[15.6, 6.8, π/4]T, υd(0)=[1, 0, 0]T, η(0)=[15.7, 6.4, π/2]T, υ(0)=[0, 0, 0]T.
假设外界扰动为
(41) |
相应地, 选取如下控制器参数: κ1=3, κ2=3, ρ=1/2, κ3= diag(1, 1, 1), κ4= diag(0.1, 0.1, 0.1), β1=1/3, β2=1/2;扰动观测器参数选取为: λ1=2.2, λ2=1.1, λ3=0.8,
由图 2可见, 本文设计的控制律可以实现快速、精确的航迹跟踪控制.除了位置跟踪, 该控制律还能实现速度跟踪, 如图 3和图 4所示.为形象强化本文所设计控制策略的有效性和优越性, 将其与传统积分滑模控制策略进行对比仿真研究, 结果如图 2 ~ 图 6所示.可以看出, FDO-ATTC具有更高的控制精度, 而且即使在无人艇遭受强扰动(41)时, 仍能确保精准航迹跟踪, 而传统的ISM方法不能保证有效的航迹跟踪(如图 2所示).由图 7和图 8可见, 在实现上述航迹跟踪控制的基础上, 该控制策略还能实现扰动的精准估计.值得一提的是, 如图 9所示, 通过选取合适的控制器参数, 所设计的控制器控制输入较为光滑, 几乎没有抖振.
5 结论本文提出了一种基于有限时间扰动观测器的航迹跟踪控制策略, 实现了复杂航行环境下无人水面艇快速、精确航迹跟踪控制.该控制方法采用有限时间扰动观测器来精确辨识外部扰动, 极大地提高了系统的鲁棒性, 并且实现了航迹的精确跟踪控制.此外, 除了保证航迹跟踪误差被镇定到零, 还可以得到具有有限时间收敛特性的跟踪效果.相比于传统的渐近收敛控制算法, 得到的有限时间稳定性确保了闭环系统具有更快的收敛速度.仿真结果进一步验证了所提出控制策略的有效性和优越性.
[1] |
Fossen T I. Marine control systems: Guidance, navigation, and control of ships, rigs and underwater vehicles[M]. Norway: Marine Cybernetics AS, 2002: 7-10.
|
[2] |
Wang N, Sun J C, Er M J. A novel extreme learning control framework of unmanned surface vehicles[J]. IEEE Trans on Cybernetics, 2015, 46(5): 106-117. |
[3] |
Wang N, Er M J. Direct adaptive fuzzy tracking control of marine vehicles with fully unknown parametric dynamics and uncertainties[J]. IEEE Trans on Control Systems Technology, 2016, 24(5): 1845-1852. DOI:10.1109/TCST.2015.2510587 |
[4] |
Wang N, Er M J, Sun J C. Adaptive robust online constructive fuzzy control of a complex surface vehicle system[J]. IEEE Trans on Cybernetics, 2016, 46(7): 1511-1523. DOI:10.1109/TCYB.2015.2451116 |
[5] |
Yan Z, Wang J. Model predictive control for tracking of underactuated vessels based on recurrent neural networks[J]. IEEE J of Oceanic Engineering, 2012, 37(4): 717-726. DOI:10.1109/JOE.2012.2201797 |
[6] |
Wang N, Er M J, Han M. Dynamic tanker steering control using generalized-ellipsoidal-basis-function-based fuzzy neural networks[J]. IEEE Trans on Fuzzy Systems, 2015, 23(5): 1414-1427. DOI:10.1109/TFUZZ.2014.2362144 |
[7] |
Wang N, Qian C J, Sun J C. Adaptive robust finite-time trajectory tracking control of fully actuated marine surface vehicles[J]. IEEE Trans on Control Systems Technology, 2016, 24(4): 1454-1462. DOI:10.1109/TCST.2015.2496585 |
[8] |
Wang N, Lv S, Zhang W, et al. Finite-time observer based accurate tracking control of a marine vehicle with complex unknowns[J]. Ocean Engineering, 2017, 145(1): 406-415. |
[9] |
Wang N, Lv S L, Liu Z Z. Global finite-time heading control of surface vehicles[J]. Neurocomputing, 2016, 175(1): 662-666. |
[10] |
Wu Y Q, Yu X H, Man Z H. Terminal sliding mode control design for uncertain dynamic systems[J]. Systems and Control Letters, 1998, 34(5): 281-287. DOI:10.1016/S0167-6911(98)00036-X |
[11] |
Zou A M, Kumar K D, Hou Z G. Finite-time attitude tracking control for spacecraft using terminal sliding mode and chebyshev neural network[J]. IEEE Trans on Systems, Man, and Cybernetics, 2011, 41(4): 950-963. DOI:10.1109/TSMCB.2010.2101592 |
[12] |
Yu S H, Yu X H, Shirinzadeh B. Continuous finite-time control for robotic manipulators with terminal sliding mode[J]. Automatica, 2005, 41(11): 1957-1964. DOI:10.1016/j.automatica.2005.07.001 |
[13] |
Feng Y, Yu X H, Man Z H. Non-singular terminal sliding mode control of rigid manipulators[J]. Automatica, 2002, 38(12): 2159-2167. DOI:10.1016/S0005-1098(02)00147-4 |
[14] |
Yu X H, Man Z H. Fast terminal sliding mode control design for nonlinear dynamic systems[J]. IEEE Trans on Circuits and System, 2002, 49(2): 261-264. DOI:10.1109/81.983876 |
[15] |
Cao W J, Xu J X. Nonlinear integral-type sliding surface for both matched and unmatched uncertain systems[J]. IEEE Trans on Automatic Control, 2004, 49(8): 1355-1360. DOI:10.1109/TAC.2004.832658 |
[16] |
Chiu C S. Derivative and integral terminal sliding mode control for a class of MIMO nonlinear systems[J]. Automatica, 2012, 48(2): 316-326. DOI:10.1016/j.automatica.2011.08.055 |
[17] |
Tiwaria P M, Janardhanannb S, Nabib M. Rigid spacecraft attitude control using adaptive integral second order sliding mode[J]. Aerospace Science and Technology, 2015, 42(1): 50-57. |
[18] |
Hong Y G, Xu Y S, Huang J. Finite-time control for robot manipulators[J]. Systems and Control Letters, 2002, 46(4): 243-253. DOI:10.1016/S0167-6911(02)00130-5 |
[19] |
Khoo S Y, Xie L H, Zhao S K. Multi-surface sliding control for fast finite-time leader-follower consensus with high order SISO uncertain nonlinear agents[J]. Int J of Robust and Nonlinear Control, 2013, 24(16): 2388-2404. |
[20] |
Shtessel Y B, Shkolnikov I A, Levant A. Smooth second-order sliding modes: Missile guidance application[J]. Automatica, 2007, 43(8): 1470-1476. DOI:10.1016/j.automatica.2007.01.008 |
[21] |
Khalil H. Nonlinear systems[M]. Upper Saddle River: Prentice Hall, 1996: 323.
|
[22] |
Skjetne R, Fossen T I, KokotoviĆ P V. Adaptive maneuvering, with experiments, for a model ship in a marine control laboratory[J]. Automatica, 2005, 41(2): 289-298. DOI:10.1016/j.automatica.2004.10.006 |