Open Access
Issue
JNWPU
Volume 39, Number 1, February 2021
Page(s) 216 - 223
DOI https://doi.org/10.1051/jnwpu/20213910216
Published online 09 April 2021

© 2021 Journal of Northwestern Polytechnical University. All rights reserved.

Licence Creative Commons
This is an Open Access article distributed under the terms of the Creative Commons Attribution License (http://creativecommons.org/licenses/by/4.0), which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

欠驱动船舶路径跟踪是典型的运动控制问题,其主要目的是在不考虑时间限制的情况下,使船跟踪上参考路径[1]。为减化其控制难度,Fossen将line of sight(LOS) 制导技术引入到路径跟踪,将三维路径跟踪转化成了一维艏向控制[2]。但由于还存有速度不易测量、内部模型不确定以及环境干扰影响等问题,对其控制仍具有难度。对此,文献[3]设计线性观测器对船舶速度进行估计。为避免线性观测器易因估计偏差较大而使控制量振荡过大的问题,文献[4]提出一种非线性速度观测器。文献[5]也设计出非线性观测器,并同时对多艘船舶的速度进行估计。文献[6]采用径向基函数(radial basis function,RBF)神经网络观测器,对速度进行逼近。除了速度不易测问题,对外界干扰及模型不确定问题的处理也十分重要。文献[7]利用高增益观测器估计流干扰引起的时变漂角值。文献[8]结合LOS制导方法,提出RBF自适应算法。文献[9]设计自适应律分别对非线性水动力函数和外部扰动上界进行估计。文献[10-11]均利用自适应控制技术,解决外界环境干扰问题。文献[12]考虑到海流干扰,设计了结合LOS的滑模自适应控制器。文献[13]所设计的增量反馈滑模控制器,可通过积分环节以避免未知项问题。文献[14]在增量反馈的基础上,通过测量实际控制装置的抖振量和引入RBF技术,对滑模抖振问题进行了抑制。文献[15-16]分别利用最小学习参数和RBF技术避免模型未知项问题。文献[17-18]提出带辅助系统的滑模算法,并利用最小学习参数神经网络对不确定项进行逼近。文献[19]利用自适应和最小学习参数法解决外界干扰和内部不确定问题,并引入双曲正切函数设计滑模面,以减缓抖振。文献[20-21]为解决内部模型不确定和外部风流干扰,设计了以扩张状态观测器为核心的自抗扰控制器。除以上问题外,因为欠驱动船舶远洋航行主要是通过提前设计的定点,来设计参考路径[22],所以这容易使船在转向点(定点)处产生超调。为此,文献[23]提出预测位置方法,有效地提高了跟踪性能,但也减小了运算速度。文献[24]在传统LOS基础上根据路径偏差范围选择不同的参考艏向,并设计多倍船长的半径,使船在进入可接受圆内时提前进行转向。其方法简捷,却对不同转向角大小设计相同的可接受圆半径,缺乏船舶转向的灵活性。

考虑以上研究成果,本文利用双曲正切函数设计非线性观测器,实现对速度的估计,以解决速度值不易获取问题。通过RBF对模型不确定项和外界干扰逼近,以补偿艏向滑模控制器。而且在RBF中引入反正切函数进行权值更新,以提高逼近性能,防止因滑模面变化过大而导致逼近精度低或振荡的问题。并在转向点处设计根据转向角大小,而调节半径大小的虚拟圆弧路径,以提高跟踪性能。最终,对比仿真结果说明了所提控制算法在改进路径跟踪性能和RBF逼近未知项性能上的有效性。

1 船舶模型和控制目标

1.1 船舶运动模型

欠驱动船舶在水平面的位置及其运动参数如图 1所示。其中, u是纵向速度,v是横向速度,ϕ是艏向角,U=(u2+v2)1/2是对地合速度,β=arctan(v/u)是漂角。本文以分离型模型(MMG)作为船舶运动模型及仿真被控系统, 考虑风浪流干扰的MMG模型可表示为[25]

thumbnail 图1

船舶位置和运动参数

式中: m是船舶质量; mxmy是附加质量; IZZ是船绕竖直轴的惯性矩; JZZ是附加惯性矩; r是转艏角速度; ϕcVc分别是流干扰的方向和速度; XW, YW和NW为风干扰力矩; XWave, YWaveNWave为浪干扰力矩; XH, YHNH是裸船体力矩; XP, YPNP是螺旋桨力矩; XR, YRNR是舵机力矩。MMG模型的输出是船舶位置(x, y, ϕ), 控制输入是舵角δ, 其隐含在舵机力矩(XRYRNR)的计算中, 舵机力矩如下

式中: δ是舵角; tR是舵阻力减额份数; αH是船体附加横向力与舵横向力的比值; xH是船体横向力作用中心到船舶重心的距离; FN是舵正压力。

1.2 路径跟踪模型和控制目标

根据运动学和船舶Norrbin模型, 建立如(3)式所示的船舶路径跟踪模型[25], 用于设计路径跟踪控制器

式中: K是旋回性指数; T是追随性指数; a是正系数, f是包括内部模型不确定和外界环境干扰的总未知项。其中,船舶速度u, vr,都不易直接测量。路径跟踪误差如图 2所示。

thumbnail 图2

路径跟踪误差

其中, ye是路径跟踪偏差, θ是参考路径角度。本文控制目标是通过路径跟踪模型(3)设计控制舵角δ, 以使船跟踪上参考路径, 即满足ye=0。所需假设条件如下

1) 总未知项f有界,即|f| <fmax

2) 船舶运动轨迹光滑, x, yϕ的二阶导数有界,即

2 路径跟踪控制器

本文路径跟踪控制器由两部分组成, 首先是基于backstepping方法的参考艏向角设计, 其次是基于RBF滑模算法的艏向控制。控制器设计结构如图 3所示。

thumbnail 图3

控制器设计结构

2.1 backstepping算法

本节基于backstepping方法设计参考艏向角ϕd。首先根据图 2和点线距离公式, 计算路径偏差如下

式中, ABC是参考路径参数。对(4)式求导有

为使(5)式和ye符号相反,设计参考艏向角如下

式中, k0k1是正参数。而由于欠驱动船舶没有侧推器, 并具有大惯性特点, 所以当船已经运动到参考定点才开始转向时, 将在转向点处产生较大超调。为避免此问题, 本文在转向点处设计虚拟圆弧路径, 如图 4所示。

thumbnail 图4

虚拟圆弧路径

其中: ω是船在转向点处的转向角; σ=π-ω是路径之间夹角; yd*是在路径衔接处所构建的虚拟圆弧路径, 其与原路径yd相切; R是圆半径; l是船进入虚拟圆弧路径点到原跟踪定点之间的距离。由图可看出R=ltan(σ/2),Rl成同增同减关系, 故本文通过设计l,以达到间接调节R的目的, 即

式中: c1c2是正参数; L是船长。半径R可根据转向角ω的大小来设计。即当ω较小时, 将设计出较小的R, 以保证船更接近定点; 当ω较大时, 对应较大R, 以减小路径超调。

2.2 RBF滑模控制器

本节通过滑模算法对艏向ϕ进行控制, 并利用RBF逼近总未知项f, 进而补偿滑模控制器。根据非线性滑模和双曲正切函数设计滑模面[14]

式中:k2k3是正参数;ϕe=ϕ-ϕd是艏向跟踪误差。对s求导并代入(3)式

为使滑模面稳定, 设计舵角如下

式中: k4是正参数; 是RBF对f的估计值。RBF设计如下

式中:h是高斯函数的输出;W是理想权值;j代表隐含层第j个节点;x是RBF输入;c是中心点矢量值;b是宽度矢量值;ε是网络逼近误差, 且可以限制得足够小。则f的估计值可表示为

式中, 是估计权值。选择Lyapunov函数如下

式中, η是正系数。对V求导如下

参考文献[16], εk4s2相比很小, 所以选择估计权值, 可有, 满足稳定条件。但选取与s呈线性比例关系的函数来调节估计权值, 容易降低RBF逼近性能: 即当参数η设计较小时,则在s较大时, 权值变化也较大, 从而容易产生振荡; 当η设计较大时, 则在s较小时, 又使得权值变化过小,从而降低了逼近精度。考虑于此, 本文利用非线性函数进行权值更新, 图 5展示了几种常见函数的对比。

thumbnail 图5

函数对比

其中, 考虑到反正切函数不仅严格有界, 并且在定义域内的值变化更广, 故本文利用反正切函数, 设计估计权值如下

式中,k5k6是正参数, k5用于压缩坐标, 以避免因s过大而导致权值过大; k6用于提高s的增益, 保证在s较小时, 权值仍能有较大响应, 从而提高逼近精度。

2.3 非线性观测器

本节利用非线性观测器估计船舶速度u, vr。首先, 对导数进行估计, 观测器设计如下

式中: lY1lY2分别是正参数, 用于限制估计误差的幅度, 以避免过大振荡; Y代表x, yϕ; Y的估计值。ϕ导数的估计值即为转艏角速度的估计值。并为估计uv, 通过所计算的估计值,对(3)式中的运动学方程进行变换如下

式中:分别是uv的估计值, 非线性观测器的输入为ϕxy, 输出为

2.4 稳定性分析

本节对所设计的backstepping算法RBF滑模算法以及非线性观测器的稳定性进行分析。选择李雅普诺夫函数如下

式中, 是速度观测器估计误差。对V*求时间导数有

代入所设计的参考艏向、控制舵角和RBF估计权值, 即(6)式, (10)式和(15)式有

因反正切函数具有严格的有界性, 所以选择合适的正参数k5 < 2/π, 可使(s-k5arctan(k6s))和s同号。当s>0时, 有s-k5arctan(k6s)>0和 >0,将增加至W- <0, 则有q <0;当s < 0时,有s-k5arctan(k6s) < 0和 < 0, 将会减小至W->0, 则有q < 0。故存有很小的正数ζ, 可使得

而由于双曲正切函数有界, 则选择合适的正参数lY2 < 1/γ, 可使z2同号。当估计误差>0时有z2>0, 并根据非线性观测器设计中的第二项有 < 0, 则将会减小, 直至z1 < 0, 此时有z1z2 < 0;相同的, 当 < 0时, z2 < 0和 >0,将会增加至z1>0, 此时仍有z1z2 < 0。并根据假设条件Ⅱ, z3有界且数量级小, 因此存在一个很小的正数μ, 可使

根据(21)式和(22)式, 则(20)式可表达为

则所提算法的稳定性可以被验证。

3 仿真分析

本节进行仿真实验, 以大连海事大学育龙号实习船作为仿真对象, 船长126 m, 船宽20.6 m, 满载吃水8 m, 满载排水量14 635 t。以分离型船舶模型(1)作为仿真船舶运动模型, 其中波浪和风干扰力计算与文献[25]相同。

仿真1   为验证所设计控制器处理外界干扰、模型不确定和速度不可测等问题的能力, 以及说明所提虚拟圆弧路径方法对路径跟踪性能提高的有效性, 在此进行仿真实验。设计参考定点: P1(0, 0), P2(4 000, 0), P3(7 000, 2 000), P4(8 000, 6 000), P5(10 000, 6 000)。船舶初始状态取为: (x, y, ϕ, u, v, r)=(0, 300 m, 0, 7.2 m/s, 0, 0), 即船到参考路径的初始偏差为300 m, 初始速度为14.4 kn。外界干扰: 风速10 m/s, 时变风向30°sin(0.02t), 流速1.0 m/s), 时变流向10°sin(0.005t), 波浪遭遇角ϕ-30°sin(0.02t), 浪波长83 m, 浪高3 m。

图 69为仿真结果。图 6中, yd是参考路径, y3是文献[24]所用设计定常倍船长的可接受半径, 以进行定点提前切换的结果, yR1yR2是所提构造虚拟圆弧的路径跟踪结果, 其中yR1是根据转向角ω大小设计可变圆弧半径, 即在(7)式中取l=L(5.5-2.5cosω)计算半径R1, 而yR2是取常数l=4L计算R2。可以看到, 在存有外界干扰和模型不确定的情况下, 3种方案均能使船准确地跟踪上参考路径。而yR1可在转向角较小的P2点处更接近路径, 在转向角较大的P4处减小超调, 说明所提可变半径圆弧方案, 能够提高路径跟踪性能。图 7可看出当转向角ω较小时, 如ω2(34°)和ω3(43°), R1将比R2更小, 以使船更接近定点; 当ω较大时, 如ω4(76°), R1将比R2更大, 以减小超调。图 8a)8b)描述了艏向ϕ和舵角δ的变化, 由于时变干扰影响, ϕδ保持着一定的角度以抵抗扰动。在船开始转向时, 因为艏向将有较大变化, 所以δ变化也较明显。图 8c)展示了所采用的RBF对总未知项f的逼近效果, 其可以成功地逼近f图 9说明了所建立非线性观测器的性能, 在大约10~20 s时, 便可准确地估计出速度u, vr

thumbnail 图6

路径跟踪

thumbnail 图7

圆弧半径

thumbnail 图8

艏向、舵角和总未知项

thumbnail 图9

纵向速度、横向速度和转艏角速度

仿真2   为验证在RBF中引入反正切函数进行权值更新, 以提高逼近未知项性能的有效性, 在此基于本文所提RBF权值更新律与文献[16]中线性更新律, 分别设计RBF滑模控制器, 并加入跳变的时变干扰, 进行对比仿真。外界干扰: ①t≤500 s时, 风速5 m/s, 流速0.3 m/s; ②500 s < t≤1 000 s时, 风速12.5 m/s, 流速0.75 m/s; ③10 00 s < t≤1 500 s时, 风速10 m/s, 流速0.5 m/s。

图 1011为仿真结果。图 10中, yNRBF是基于本文所提非线性权值更新方法的路径跟踪结果, yLRBF是线性权值更新的结果, yd是参考路径。可看到yNRBFyLRBF都能跟踪上参考路径, 由于跳变时变干扰的影响, 在(3 200 m, 0)附近, 产生不到5 m的波动, 但很快趋于稳定, 收敛在船宽的1/10以内, 即不到2 m, 这符合实际航行情况, 其中yNRBF的波动幅度较小一些。图 11a)描述了所提RBF神经网络估计总未知项f的结果。在50 s左右, fNRBF便能成功地逼近f图 11b)展示了RBF逼近误差fe的对比结果, 其中, feNRBFfeLRBF分别是基于反正切函数和线性函数的逼近误差。可以看出在突变干扰产生时(t=500 s/1 000 s附近), feNRBF的变化幅度更小, 收敛速度也较快。说明所提权值更新法, 可提高RBF对f的逼近性能。

thumbnail 图10

不同RBF的路径跟踪

thumbnail 图11

总未知项和逼近误差

4 结论

本文通过backstepping法将欠驱动船舶路径跟踪转换为艏向控制,其次设计RBF神经网络滑模控制器,以对艏向进行控制。其中,基于双曲正切函数建立速度观测器,以解决速度不易获取问题。此外,构建根据转向角来调节半径的圆弧路径,以提高路径跟踪性能。并引入反正切函数对RBF权值进行更新,以提高对模型总未知项的逼近性能。最终对比实验表明:不需速度的测量,控制器仍能使船在风浪流时变干扰下准确地跟踪上参考路径。既减小了路径超调,又尽可能地逼近参考定点,且提高了对未知项的逼近精度。说明了控制器解决速度不易测﹑外部干扰和内部不确定的能力,以及改进路径跟踪和RBF逼近性能的有效性。下一步研究将考虑以螺旋桨和舵角为多控制输入的船舶轨迹跟踪控制。

References

  1. Wang J Q, Zou Z J, Wang T. High-gain extended state observer based adaptive sliding mode path following control for an underactuated vessel sailing in restricted waters[J]. Applied Sciences, 2019, 9(1102):1–21 [Article] [Google Scholar]
  2. Lekkas A M, Fossen T I. Integral LOS path following for curved paths based on a monotone cubic hermite spline parametrization[J]. IEEE Trans on Control Systems Technology, 2014, 22(6):2287–2301 [Article] [Google Scholar]
  3. Padideh R, Khoshnam S, Abbas C. Output feedback look-ahead position control of electrically driven fast surface vessels[J]. Automatika, 2016, 57(4):968–981 [Article] [Google Scholar]
  4. Shen Zhipeng, Bi Yannan, Guo Tantan, et al. Adaptive dynamic surface output feedback trajectory tracking control for underactuated ships with nonlinear observer[J]. Systems Engineering and Electronics, 2019, 41(2):409–416 [Article] (in Chinese) [Google Scholar]
  5. Ding Fuguang, Ma Yanqin, Wang Yuanhui, et al. Robust synchronization control of multiple vessels with state observer[J]. Journal of Harbin Engineering University, 2015, 36(6):789–794 [Article] (in Chinese) [Google Scholar]
  6. Shen Zhipeng, Zhang Xiaoling, Zhang Ning, et al. Recursive sliding mode dynamic surface output feedback control for ship trajectory tracking based on neural network observer[J]. Control Theory & Applications, 2018, 35(8):1092–1100 [Article] (in Chinese) [Google Scholar]
  7. Wang Y H, Tong H Y, Wang C L. High-gain observer-based line-of-sight guidance for adaptive neural path following control of underactuated marine surface vessels[J]. IEEE Access, 2019, 7: 19258–19265 [Article] [Google Scholar]
  8. Fan Y S, Huang H Y, Tan Y Y. Robust adaptive path following control of an unmanned surface vessel subject to input saturation and uncertainties[J]. Applied Sciences, 2019, 9(1815):1–18 [Article] [Google Scholar]
  9. Liu Z Q. Pre-filtered backstepping control for underactuated ship path following[J]. Polish Maritime Research, 2019, 26(2):68–75 [Article] [Google Scholar]
  10. Vo D D, Pham V A, Nguyen D A. Design an adaptive autopilot for an unmanned surface vessel[C]//Proceeding of the 4th International Conference on Green Technology and Sustainable Development, Ho Chi Minh City, Vietnam, 2018: 323–328 [Google Scholar]
  11. Herman P, Adamski W. Non-adaptive velocity tracking controller for a class of vehicles[J]. Bulletin of the Polish Academy of Sciences Technical Sciences, 2017, 65(4):459–468 [Article] [Google Scholar]
  12. Chen X, Liu Z, Zhang J Q, et al. Adaptive sliding-mode path following control system of the underactuated USV under the influence of ocean currents[J]. Journal of Systems Engineering and Electronics, 2018, 29(6):1271–1283 [Article] [Google Scholar]
  13. Liu Y, Bu R X, Gao X R. Ship trajectory tracking control system design based on sliding model control algorithm[J]. Polish Maritime Research, 2018, 25(3):26–34 [Article] [Google Scholar]
  14. Shen Zhipeng, Dai Changsheng, Zhang Ning. Trajectory tracking control of underactuated ship based on adaptive iterative sliding mode[J]. Journal of Traffic and Transportation Engineering, 2017, 17(6):125–134 [Article] (in Chinese) [Google Scholar]
  15. Shen Zhipeng, Wang Ru. Adaptive sliding mode trajectory tracking control of underactuated ship based on DSC-MLP[J]. Systems Engineering and Electronics, 2018, 40(3):643–651 [Article] (in Chinese) [Google Scholar]
  16. Zhang He, Yao Jie, Sui Jianghua, et al. Neural sliding mode path following control for underctuated ship based on DSC[J]. Ship Engineering, 2019, 41(10):85–91 [Article] (in Chinese) [Google Scholar]
  17. Mu D D, Wang G F, Fan Y S, et al. Adaptive trajectory tracking control for underactuated unmanned surface vehicle subject to unknown dynamics and time-varing disturbances[J]. Applied Sciences, 2018, 8(547):1–16 [Article] [Google Scholar]
  18. Yu Y L, Guo C, Yu H M. Finite-time predictor line-of-sight-based adaptive neural network path following for unmanned surface vessels with unknown dynamics and input saturation[J]. International Journal of Advanced Robotic System, 2018, 15(6):1–14 [Article] [Google Scholar]
  19. Qiu B B, Wang G F, Fan Y S, et al. Adaptive sliding mode trajectory tracking control for unmanned surface vehicle with modeling uncertainties and input saturation[J]. Applied Sciences, 2019, 9(1240):1–18 [Article] [Google Scholar]
  20. Li Ronghui, Cao Junhai, Li Tieshan. Active disturbance rejection control design and parameters configuration for ship steering with wave disturbance[J]. Control Theory & Applications, 2018, 35(11):1601–1609 [Article] (in Chinese) [Google Scholar]
  21. Liu L, Wang D, Peng Z H, et al. Cooperative path following ring-networked under-actuated autonomous surface vehicles: algorithms and experimental results[J]. IEEE Trans on Cybernetics, 2020, 50(4):1519–1529 [Article] [Google Scholar]
  22. Liu C G, Zheng H R, Negenborn R, et al. Adaptive predictive path following control based on least squares support vector machines for underactuated autonomous vessels[J]. Asian Journal of Control, 2019, 2208: 1–17 [Article] [Google Scholar]
  23. Nagai T, Watanabe R. Applying position prediction model for path following of ship on curved path[C]//Proceeding of the IEEE Region 10 Conference, Singapore, 2016: 22–25 [Google Scholar]
  24. Wang S S, Wang L J, Qiao Z X. Optimal Robust control of path following and rudder roll reduction for a container ship in heavy waves[J]. Applied Sciences, 2018, 8(1631):1–19 [Article] [Google Scholar]
  25. Li Z X, Li R H, Bu R X. Path following of under-actuated ships based on model predictive control with state observer[J]. Journal of Marine Science and Technology, 2020, (4):1–11 [Article] [Google Scholar]

All Figures

thumbnail 图1

船舶位置和运动参数

In the text
thumbnail 图2

路径跟踪误差

In the text
thumbnail 图3

控制器设计结构

In the text
thumbnail 图4

虚拟圆弧路径

In the text
thumbnail 图5

函数对比

In the text
thumbnail 图6

路径跟踪

In the text
thumbnail 图7

圆弧半径

In the text
thumbnail 图8

艏向、舵角和总未知项

In the text
thumbnail 图9

纵向速度、横向速度和转艏角速度

In the text
thumbnail 图10

不同RBF的路径跟踪

In the text
thumbnail 图11

总未知项和逼近误差

In the text

Current usage metrics show cumulative count of Article Views (full-text article views including HTML views, PDF and ePub downloads, according to the available data) and Abstracts Views on Vision4Press platform.

Data correspond to usage on the plateform after 2015. The current usage metrics is available 48-96 hours after online publication and is updated daily on week days.

Initial download of the metrics may take a while.