Chinese Journal of Ship Research
带漂角和输入饱和的水面船舶航向控制
陆潇杨,刘志全*,高迪驹,褚建新上海海事大学航运技术与控制工程交通运输行业重点实验室,上海201306
引用格式:陆潇杨,刘志全,高迪驹, 等.带漂角和输入饱和的水面船舶航向控制[J]. 中国舰船研究, 2021, 16(2): 194–202. LU X Y, LIU Z Q, GAO D J, et al. Surface ship heading control with sideslip angle and input saturation[J]. Chinese Journal of Ship Research, 2021, 16(2): 194–202.
摘 要:[目的]为处理水面船舶航向控制过程中受到的非零漂角和输入饱和影响,提出一种基于反步法的航向控制方法。[方法]首先,利用相对速度求出实际漂角,再通过漂角对航向角误差进行修正;然后,采用一种预滤波方法减小航向改变时对航速变化的影响,同时引入双曲正切函数和Nussbaum 函数逼近输入约束,结合自适应律对逼近误差和艏摇方向上的扰动进行估计;最后,借助指令滤波器简化反推过程,并通过Lyapunov理论证明控制系统的稳定性。[结果]仿真结果表明,所提控制器有效减小了水面船舶的航向输出误差,且能始终保持较小的控制输入力矩。[结论]研究成果可为水面船舶航向控制设计提供参考。关键词:航向控制;反步法;漂角;输入约束中图分类号: U664.82 文献标志码:A DOI:10.19693/j.issn.1673-3185.01775
Surface ship heading control with sideslip angle and input saturation
LU Xiaoyang, LIU Zhiquan*, GAO Diju, CHU Jianxin
Key Laboratory of Marine Technology and Control Engineering Ministry of Communications, Shanghai Maritime University, Shanghai 201306, China
Abstract: [Objectives]To address the impact of non-zero sideslip angle and input saturation on the heading control of a surface ship, a method based on a backstepping control algorithm is proposed.[Methods] The actual sideslip angle is obtained through the relative velocity, and heading angle error is amended using the sideslip angle. A pre-filter is used to minimize the impact of speed change when the heading alters. Hyperbolic tangent and Nussbaum functions are introduced to approximate the input constraint, an adaptive law is designed to estimate approximation errors and disturbances in the yaw direction, and a command filter is proposed to simplify the design of the backstepping controller. The stability of the control system is proved by Lyapunov's theory.[Results ] The simulation results show that the proposed controller can effectively reduce the heading output error of a surface ship while simultaneously maintaining a small control input torque.[Conclusions]The study results can provide reference for the heading control design of surface ships. Key words: heading control;backstepping;sideslip angle;input constraint
0 引 言
航向控制作为船舶控制领域的首要问题,一直是国内外学者研究的热点。随着控制理论的发展,从 PID[1]、滑模[2]、神经网络[3] 到模糊自适应[4-5]等智能优化算法,很多控制理论都被应用到船舶
控制领域并取得了理想的控制效果,但也存在一定的局限性。例如,神经网络所需设备较昂贵且计算时间长,不利于工程实现,而模糊规则的制定复杂且难以推广。彭秀艳和胡忠辉 针对海浪滤波和状态估计问题,设计了反步自适应输出反馈控制器,但传统反步法中易出现“计算爆炸”情
况。林郁[7]提出的一种可减少控制器计算负担的滤波器能够有效避免此问题,但未考虑该方法在欠驱动水面船舶上的适用性。然而,海上实际使用的多数船舶都属欠驱动系统,即仅利用主推进和舵装置驱动完成船舶操纵任务。Liu 等[8] 利用反步法并结合改良的视线法,将欠驱动路径跟踪控制问题转化为了虚拟全驱动控制问题,但对风、浪、流等外部干扰因素考虑不周,且忽略了船舶运动时非零漂角的影响。漂角是船体受不对称水流作用发生偏转时纵剖面与水流方向形成的夹角,其对船舶操纵效果有一定的影响,通常很少考虑。Yu 等[9] 提出通过漂角修正来实现航向控制,但需要借助全球定位系统(GPS) 和速率传感器。在不借助GPS 的情况下,Hu 等[10] 根据船舶相对速度进一步求得了实际漂角,Wang 等[11] 则利用有限时间观测器并结合视线法,对受漂角影响的船舶进行了航迹控制设计,但未考虑输入饱和问题。作为实际控制系统中的常见现象,执行器饱和会降低系统性能,甚至导致闭环系统的不稳定性,因此要解决船舶控制问题,就必须考虑受限约束条件下系统的稳定性。Lin等[12] 提出了适用于未知时变环境扰动及输入饱和情况的自适应模糊输出反馈控制器,Ma等[13] 提出了一种基于径向基神经网络,采用动态面控制和反步法相结合的方法,用于处理饱和问题,但该方法只能用于单输入单输出系统。针对以上提到的水面船舶运动中出现的漂角及输入饱和问题,本文将设计一种带漂角修正和输入约束的鲁棒自适应反步航向控制器。首先采用光滑双曲正切函数和 Nussbaum 函数逼近约束条件,利用自适应技术处理未知扰动,然后引入指令滤波器并结合反步法设计航向控制器,以及通过 Lyapunov 理论证明其有界性,最后进行仿真实验验证该控制方法的有效性。1 问题描述假设船舶关于xz平面对称,且垂荡、横摇、纵摇方向上的运动可忽略不计。为便于设计控制器,纵荡速度u由独立控制系统控制,故假设其为常数,横荡速度v与船舶操纵中其他运动变量相比较小,故设其被动有界[14],则水面船舶动力学模型通常可以简化为在艏摇和横荡方向上的两自由度运动,描述如下[15]:
式中:ψ为船舶的实际航向角,(°) ; r为船舶的艏摇角速度, rad/s; mi (i = 1, 2, 3)为包含附加质量影响的船舶惯性参数, kg ; φ为艏摇力矩,N·m,是唯一的控制输入; τ(φ)为饱和执行器输出, N·m ; ωr和ωv分别为艏摇和横荡方向上有未知界的时变扰动;艏摇和横荡方向上的阻尼函数f1(r) , f2(v)分别表示如下:
式中: ∆ = ωr + µ(φ) ,由于ωr和µ(φ)均有界,则∆有界,且假设|∆| ⩽ σ;定义σˆ , σ˜分别为界值常数σ的估计值和估计误差,即σ˜ = σˆ − σ ; c为正常数;由于实际控制输入φ难以直接计算得出,因此定义一个辅助变量ϕ以方便后续的控制器设计。针对受非零漂角和输入饱和影响的水面船舶,提出一种基于反步法的航向控制方法,目标如下: 1)减小航向输出误差;
2)控制输入力矩并始终保持在较小值。2 控制系统2.1 预滤波器
为避免船舶航向角突然改变较大导致航速变化明显,而对研究时假设的条件造成影响,采用了一种预滤波方法,这样既可使船舶航向平滑过渡,又可保证控制器的鲁棒性。在期望航向角ψd处加入一个预滤波器,输出光滑、缓慢变化的参考航向角ψdr及其导数作为参考输入。提出的二阶预滤波器可以写为[16] n1 ψ 2 + n2 ψdr + n3 = n4 ψd (8) dr式中,ni (i = 1, 2, 3, 4)为二阶预滤波器的参数。2.2 漂角修正在航向控制设计中,通常假设漂角为0,选择期望路径的切线角作为期望航向角ψd ,航向误差e = ψ − ψd。然而,实际上漂角是存在的,且会对航行造成一定的影响,特别是对欠驱动水面船舶来说,利用一个输入来控制横荡和艏摇运动,使船舶的重力速度方向与航向不一致,将会导致船舶逐渐偏离航线。可以利用漂角来修正所需航向的不合理性。在如图1所示的地面坐标系OXo Yo及船体坐标系BXb Yb中,由于船舶重心速度方向与期望路径的切线角相差一个漂角[10],所以结合预滤波器。漂角修正后的期望航向角ψda和航向误差ea 如下: (9) 2.3 控制器在设计控制器之前,为避免在虚拟控制律求导过程中出现复杂的计算问题,引入了一种指令滤波器[17],可以表示为
的小邻域内,由式 (38) 可得出V3和zi (i = 1, 2, 3)是最终一致有界的,即对于任意δ> 0 , t > 0, |zi (t)| <δ (i = 1, 2, 3)成立[17]。
|ea | = |ψ − ψda | = |ψ − ψd + β| = |z1 | <δ, t > T,因此,即航向误差也是最终一致有界且稳定的。由zi (i = 1, 2, 3)的有界性可知,控制律ϕ和ϕ¯、虚拟控制律αi0(i = 1, 2)及其相应的αi、辅助系统状态量ei (i = 1, 2)和σ的估计误差均有界,结合其他前面所提到的信号也有界,即闭环系统中所有信号均有界。对于控制器参数值,除ki (i = 1, 2, 3)外,其他
参数也会对控制精度造成影响。例如kei (i = 1, 2)和γσ越大,得到的航向误差越小,但同时也会导致控制输入增大。过大的控制输入(艏摇力矩)会加速舵机的磨损。因此,需要选择合适的控制器参数以保持航向控制性能和控制输入之间的协调。控制器整体控制流程如图2所示。
3 仿真结果与分析
为了验证所提控制器的有效性,选择垂荡、横摇、纵摇忽略不计,包含艏摇、横荡、纵荡的船
舶运动的两自由度水面船舶数学模型为仿真对象。式 (7)中的相关参数具体见文献[20],控制输入约束τM = 1.5 × 107 N · m。设置船舶速度为15m /s,
期望航向角分别为15◦ , −30◦ , 0◦ , 20◦和−5◦。仿真结果如图3~图 6所示。为保证仿真结果的可靠性,分别在3 级和5级海况下,根据有、无预滤波器这2 种情况,对3种不同控制器进行比较。在无预滤波器( ψdr = ψd )处理情况下,对带漂角修正和输入约束的控制器、仅考虑漂角修正的反步控制器和既不考虑漂角修正也不带输入约束的传统反步控制器进行了仿真分析,图中分别用约束无滤波、漂角无滤波和传统无滤波表示。在基于预滤波器处理的情况下(参考航向角ψdr随预滤波器处理变化),对带漂角修正和输入约束的控制器、仅考虑漂角修正的反步控制器和既不考虑漂角修正也不带输入约束的传统反步控制器进行了仿真分析,图中分别用约束预滤波、漂角预滤波和传统预滤波表示。图中,饱和极限指舵能正常使用时的控制输入极限值。仿真过程中涉及到的不同控制方法的相关参数如表1所示。在不同海况下,相同的初始条件和相关参数值是保持一致的。漂角大小对航向角的影响不可忽视,未经预滤波处理的3种不同控制器在3,5级海况下输出的航向角及其相应的航向角误差的仿真结果如图 3所示。在不同海况下,无论是航向角还是航
向角误差,相同控制器的输出结果差别很小。相比相同海况下的不同控制器,航向突然改变会导致超调量增加,所以3种控制器的输出误差均很大。由图 3(b) 和图 3 (d)可见,忽略漂角影响的控制器输出的航向误差不能收敛至0。而与其他控制器相比,带漂角修正和输入约束的控制器则能有效提高船舶航向控制性能,减小航向角误差,并能在较短的时间内明显抑制系统超调量的增加,即对于每次航向改变,带漂角修正和输入约束的控制器均能保证在5 ∼ 8 s 内使系统趋于稳定,相比其他2种控制器,其达到稳定的时间缩短了一半甚至是更多,超调量平均减少了90% 以
上,且处于稳定状态时,其与传统控制器相比航向误差减小了1◦ ∼ 2◦。
图 4(a) 和图 4 (c) 给出了3 级和5级海况下未经预滤波处理的3种控制器的艏摇力矩仿真结果。由图可见,当航向发生变化时,未考虑输入饱和控制器的艏摇力矩很大,已远远超出舵能正常使用的极限值,尤其是仅考虑漂角的控制器无论是在3 级还是5级海况下时,艏摇力矩不仅大而且变化剧烈。为解决该问题,在设计带漂角修正和输入约束的控制器时,增加了输入约束并进行了相应的处理,使其无论航向是否改变,艏摇力矩都保持在很小的范围内,即平均位于−3 ∼ 3N ·m
范围内,为饱和极限的2 × 10−7倍,且在应对更剧烈的海况时艏摇力矩变化频率将更稳定,如图4(b)和图 4(d) 所示。基于预滤波处理的3种不同控制器在3 级和5级海况下输出的航向角及其相应的航向角误差仿真结果如图5所示。与图3 相同,在不同海况下,相同控制器的输出航向角、航向角误差无明显差别;在相同海况下,带漂角修正和输入约束的控制器仍然是3种控制器中控制性能最好的。与图 3(b)相比,在航向变化时能够更加平滑地过渡,且超调量几乎为0,航向误差不超过±8◦ ,与无预滤波作用的漂角约束控制器相比航向误差平均减小了约40%,这也是与图 3(b) 相比差别最大处。图 6(a) 和图 6 (c) 给出了3 级和5级海况下经4 结 语本文针对水面船舶航向运动中出现的非零漂角和输入饱和问题,结合反步控制算法提出了一种鲁棒自适应航向控制器,可有效减小非零漂角对航向的影响,采用预滤波方法使船舶航向改变时能够平滑过渡,双曲正切函数和指令滤波器的引入有效解决了控制器设计过程中反步法的应用难题。所提出的控制器可以实现用较小的控制输入准确跟踪期望航向的目标,有效改善了水面船舶的航向控制性能。然而,需要指出的是,本文在建模时简化了模型,没有过多考虑船舶非线性动态和参数不确定情况,同时控制精度也有待提高,航向误差的超调量还可进一步减小,今后将从这几个方面开展研究。参考文献: [1] 赵志平, 张强. 船舶航向的自适应自调节PID 跟踪控制 [J]. 中国舰船研究, 2019, 14(3): 145–151.过预滤波处理的3种控制器的艏摇力矩仿真结果。图6内各控制器的比较结果与图4的分析基本相同。但在相同海况下,从其与图4中相同控制器的比较结果来看,发现经过预滤波处理的3种不同控制器在航向改变时艏摇力矩比未处理时的小,即预滤波器也能在一定程度上降低较大舵角的要求。上述2种工况下不同控制方法的主要性能参数如表2所示。通过比较表中几种不同的控制方法,可以看出基于预滤波处理的漂角约束控制器更具优越性,不仅响应速度快,到达稳定状态的调节时间更短,无明显超调,而且艏摇力矩一直保持在很小的范围内,即使面对不同的海况,其控制效果依旧表现良好,具有较强的鲁棒自适应能力。ZHAO Z P, ZHANG Q. Adaptive self-regulation PID tracking control for the ship course[J]. Chinese Journal of Ship Research, 2019, 14(3): 145–151 (in Chinese). [2] 秦梓荷, 林壮, 李平, 等. 基于 LOS 导航的欠驱动船舶滑模控制 [J]. 中南大学学报(自然科学版), 2016, 47(10): 3605–3611. QIN Z H, LIN Z, LI P, et al. Sliding-mode control of underactuated ship based on LOS guidance[J]. Journal of Central South University (Science and Technology), 2016, 47(10): 3605–3611 (in Chinese). [3] 王欣, 刘正江, 李铁山, 等.船舶航向离散非线性系统自适应神经网络控制[J]. 哈尔滨工程大学学报, 2016, 37(1): 123–126. WANG X, LIU Z J, LI T S, et al. Neural networkbased adaptive control for a ship course discrete-time nonlinear system[J]. Journal of Harbin Engineering University, 2016, 37(1): 123–126 (in Chinese). [4] 范云生, 李长飞, 王国峰, 等.无人水面艇航向跟踪控制器的设计与验证 [J]. 大连海事大学学报, 2017, 43(1): 1–7. FAN Y S, LI C F, WANG G F, et al. Design and validation of course tracking controller for unmanned sur
face vehicle[J]. Journal of Dalian Maritime University, 2017, 43(1): 1–7 (in Chinese). [5] YIN S, YU H, SHAHNAZI R, et al. Fuzzy adaptive tracking control of constrained nonlinear switched stochastic pure-feedback systems[J]. IEEE Transactions on Cybernetics, 2017, 47(3): 579–588. [6] 彭秀艳, 胡忠辉.带有海浪滤波器的船舶航向反步自适应输出反馈控制 [J]. 控制理论与应用, 2013, 30(7): 863–868. PENG X Y, HU Z H. Adaptive nonlinear output feedback control with wave filter for ship course[J]. Control Theory & Applications, 2013, 30(7): 863–868 (in Chinese). [7] 林郁.基于滤波反步法的船舶航向跟踪控制[J]. 大连海事大学学报, 2015, 41(1): 6–9. LIN Y. Command filtered Backstepping-based design for course-keeping control of ship[J]. Journal of Dalian Maritime University, 2015, 41(1): 6–9 (in Chinese). [8] LIU T, DONG Z P, DU H W, et al. Path following control of the underactuated USV based on the improved Line-of-Sight guidance algorithm[J]. Polish Maritime Research, 2017, 24(1): 3–11. [9] YU Z Y, BAO X P, NONAMI K. Course keeping control of an autonomous boat using low cost sensors[J]. Journal of System Design and Dynamics, 2008, 2(1): 389–400. [10] HU C, WANG R G, YAN F J, et al. Robust composite nonlinear feedback path-following control for underactuated surface vessels with desired-heading amendment[J]. IEEE Transactions on Industrial Electronics, 2016, 63(10): 6386–6394. [11] WANG N, SUN Z, YIN J C, et al. Finite-time observer based guidance and control of underactuated surface vehicles with unknown sideslip angles and disturbances[J]. IEEE Access, 2018, 6: 14059–14070. [12] LIN X G, NIE J, JIAO Y Z, et al. Adaptive fuzzy output feedback stabilization control for the underactuated surface vessel[J]. Applied Ocean Research, 2018, 74: 40–48. [13] MA J J, ZHENG Z Q, LI P. Adaptive dynamic surface control of a class of nonlinear systems with unknown direction control gains and input saturation[J]. IEEE Transactions on Cybernetics, 2015, 45(4): 728–741. [14] LI J H, LEE P M, JUN B H, et al. Point-to-point navigation of underactuated ships[J]. Automatica , 2008, 44(12): 3201–3205. [15] DO K D. Global robust adaptive path-tracking control of underactuated ships under stochastic disturbances[J]. Ocean Engineering, 2016, 111: 267–278. [16] PERERA L P, SOARES C G. Pre-filtered sliding mode control for nonlinear ship steering associated with disturbances[J]. Ocean Engineering, 2012, 51: 49–62. [17] ZHENG Z W, HUANG Y T, XIE L H, et al. Adaptive trajectory tracking control of a fully actuated surface vessel with asymmetrically constrained input and output[J]. IEEE Transactions on Control Systems Technology, 2018, 26(5): 1851–1859. [18] POLYCARPOU M M, IOANNOU P A. A robust adaptive nonlinear control design[J]. Automatica , 1996, 32(3): 423–427. [19] WEN C Y, ZHOU J, LIU Z T, et al. Robust adaptive control of uncertain nonlinear systems in the presence of input saturation and external disturbance[J]. IEEE Transactions on Automatic Control, 2011, 56(7): 1672–1678. [20] CHWA D. Global tracking control of underactuated ships with input and velocity constraints using dynamic surface control method[J]. IEEE Transactions on Control Systems Technology, 2011, 19(6): 1357–1370.