基于有限时间观测器的水面船舶轨迹跟踪控制方法.pdf

Pure Mathematics 理论数学理论数学,2023,13(10),3104-3110 Published Online October 2023 in Hans.https:/www.hanspub.org/journal/pm https:/doi.org/10.12677/pm.2023.1310321 文章引用文章引用:刘志民.基于有限时间观测器的水面船舶轨迹跟踪控制方法J.理论数学,2023,13(10):3104-3110.DOI:10.12677/pm.2023.1310321 基于基于有限时间观测器的水面船舶有限时间观测器的水面船舶轨迹跟踪控制轨迹跟踪控制方法方法 刘志民刘志民 上海出版印刷高等专科学校，基础教学部，上海 收稿日期：2023年9月23日；录用日期：2023年10月24日；发布日期：2023年10月31日 摘摘 要要 本文针对欠驱动自水面船舶的运动学和动力学特征，设计了一种带观测器的有限时间跟踪控制器，把系本文针对欠驱动自水面船舶的运动学和动力学特征，设计了一种带观测器的有限时间跟踪控制器，把系统的运动和动力学模型分为两个子系统，速度控制子系统和转向控制子系统，针对速度控制子系统，引统的运动和动力学模型分为两个子系统，速度控制子系统和转向控制子系统，针对速度控制子系统，引入了带有观测器的虚拟控制器，针对转向控制子系统，设计了有限时间滑模控制策略，入了带有观测器的虚拟控制器，针对转向控制子系统，设计了有限时间滑模控制策略，所设计的控制系所设计的控制系统具有统具有有限时间有限时间全局稳定性。全局稳定性。可以较好地实现位置跟踪和方向控制可以较好地实现位置跟踪和方向控制。最后，将所提出的控制算法应用于。最后，将所提出的控制算法应用于水面船舶水面船舶，仿真结果表明了，仿真结果表明了该控制器具有快速的响应性和一定的鲁棒性该控制器具有快速的响应性和一定的鲁棒性。关键词关键词 有限时间控制有限时间控制，水面船舶水面船舶，轨迹跟踪轨迹跟踪 A Control Method for Surface Ship Trajectory Tracking Based on Finite Time Observer Zhimin Liu Department of Foundational Teaching,Shanghai Publishing and Printing College,Shanghai Received:Sep.23rd,2023;accepted:Oct.24th,2023;published:Oct.31st,2023 Abstract This article designs a finite time tracking controller with observers for the kinematic and dynamic characteristics of underactuated self propelled surface vessels.The motion and dynamic model of the system is divided into two subsystems:speed control subsystem and steering control subsys-刘志民 DOI:10.12677/pm.2023.1310321 3105 理论数学 tem.For the speed control subsystem,a virtual controller with observers is introduced,and for the steering control subsystem,a finite time sliding mode control strategy is designed,the de-signed control system has finite time global stability.It can effectively achieve position tracking and direction control.Finally,the proposed control algorithm was applied to surface vessels,and simulation results showed that the controller has fast responsiveness and certain robustness.Keywords Finite Time Control,Surface Vessel,Trajectory Tracking Copyright 2023 by author(s)and Hans Publishers Inc.This work is licensed under the Creative Commons Attribution International License(CC BY 4.0).http:/creativecommons.org/licenses/by/4.0/1.引言引言 在过去的一段时间里，具有不可积约束的欠驱动系统的控制越来越受到人们的关注1。由于 Brockett条件的限制，这样的系统不是局部线性可控的，并且不能通过任何光滑(甚至连续)的时不变控制律渐近稳定2 3。为了克服这一困难，提出了许多新的非线性方法。所提出的具有不可积约束的欠驱动系统的稳定解包括光滑时变控制律、不连续或分段光滑控制律和混合控制律4 5 6。以往的工作大多集中在具有速度不可积约束的非完整系统上。在许多实际应用场景比如具有欠驱动系统由于两轮自平衡机器人，其具有内在的的不稳定性，通过对其进行主动控制保持其直立位置，其轮子被独立驱动以提供需要机器人保持平衡的力(力矩)，各种线性和非线性控制系统被设计出来。欠驱动船舶是一种重要的民事和军事工具，其控制问题近年来显得尤为重要。7中提出了一种连续反馈控制律，保证位置变量指数收敛到其期望值，并且方向变量收敛到某个常数值。在8中，提出了一种不连续反馈控制律，在初始状态的某些假设下，提供所有状态到其期望值的指数收敛。9中，提出了一种时变反馈控制律，在吸引池大小未知的情况下，实现所需平衡点的局部指数(相对于给定膨胀)稳定性。10中，提出了一种时变反馈控制律，以确保运动船舶模型的半全局实际指数稳定性，其中喘振和偏航速度作为控制输入。基于另一简化模型。上述关于欠驱动水面舰艇稳定性的文献综述表明，实现全局指数收敛于所需设定点的控制律，如11 12 13 14 15中提出的控制律甚至不能保证所需设点的局部渐近稳定性；实现闭环系统全局一致渐近稳定的控制律，如16 17 18 19 20中提出的控制律是时变的，并且只产生对所需设定点的渐近收敛。对这种欠驱动系统，传统的渐进稳定控制方法设计起来变得越来越困难，本文采用有限时间控制策略，对水面船舶进行有效控制。2.控制对象运动数学模型控制对象运动数学模型 本文的研究对象为欠驱动水面船舶，其运动示意图如图 1 所示。对于多数欠驱动水面航行器，通常忽略其在垂直面内的运动情况，即只考虑其在纵向、横向和转向运动，本文针对欠驱动水面船舶控制跟踪问题，旨在找到稳定、响应时间快，控制精度高的解决方法，借助于 fossen 19所建立的船舶水平面运动方程，假设以下条件成立：1)船体的惯性主轴和船体坐标系重合：2)船体的几何重心为船体坐标系原点；3)船体及所载重货物质量均匀分布；Open AccessOpen Access刘志民 DOI:10.12677/pm.2023.1310321 3106 理论数学 Figure 1.Schematic diagram of the navigation coordinate system of surface ships 图图 1.水面船舶航行坐标系示意图 ()()()()()1122111122112223322113333cossinsincosdisdisdism um vrd um vm urd vm rmmuvd rxuvyuvr+=+=+=+=+=(1)(1)式中，u，v和r分别为船体坐标系中纵向、横向和角速度；x，y，为惯性系中船舶的位置和方向。0iim，1,2,3i=是水面船舶的惯性和附加质量系数。0iid，1,2,3i=为水面船舶的水动力系数。可用的控制输入为螺旋桨推力1和转向力矩3。侧向一般不配备单独的推进器。假设有如下的参考轨迹(),ddddddu v r xy 满足()()()()()11221111 is2211222 is3322113333 is+cossinsincosdd dddddd dddddddddddddddddddddm um v rd um vm u rd vm rmmu vd rxuvyuvr+=+=+=+=(2)令()()TT123456,z zz zz zx yu v r=T,其中 T 为如下可逆矩阵 刘志民 DOI:10.12677/pm.2023.1310321 3107 理论数学 ()()()()()()22221122cossin0000sincos000001000cossin000000010001001mdmd 由数学知识可知，()()()()()()()()()()22221122112211221122cossin0000sincos000cossin000001000sincos0010cossin000001001000010001001,mdmdmdmdmd=均为正数。故以上的坐标变换为可逆变换。对参考轨迹做相同的变换，有()()()()()()122222334112256cossin0000sincos000001000cossin000000010001001dddddddddddddddddzxzymdzzumdzvzr=,(3)()()()()1112222261222112233333ddddddddddFddud zzdFmmu vd rm=+,令 T123456T112233445566,dddddde e e e e ezzzzzzzzzzzz=e 则有如下的跟踪误差动力学方程()()()1142 626625 65665224 64664223614112251 616614 646645362233dddddisdddisddddddisdeaeaee ez ez eb e ez ez eee ez ez edeeeFFdec e ez ez ee ez ez eceeFFm=+=+=+=+=+(4)刘志民 DOI:10.12677/pm.2023.1310321 3108 理论数学 3.控制器设计策略控制器设计策略 考虑误差系统(4)，则如下的控制律()()11144223226633disddisdFFkedFFkem=+=+(5)以及未知有上界的扰动自适应估计律()()11413261,disdisdisdisproj eproj e=(6)则可以所讨论的被控对象扰动条件下跟踪误差的有限时间收敛。(5)式中，()()()()22 243 3336216231261442242 4634446,ddddddddddk ezk ek ezggzk ggzgzzgk zk ezgzee z=+=+=+=+=+23456,k k k k k均为正数。(6)式中，12,为自适应系数，proj定义为()()()()()(),0,001,00proj=且且 (7)其中()2222MM=+，()()=，为任意小的正数，为的估计值，M，M为最大估计值。证明：由(4)可知，当0tt时，2346,e e e e有界，且6e有限时间收敛。由式(5)可知，2dis为渐进收敛，由(4)知道24,e e也为有限时间收敛量。把2dis看做输入变量，由输入状态稳定理论，可知15,e e有界且可以在有限时间内收敛于 0。因为()3226633disdFFkem=+，李雅普诺夫函数选取如下()22216331122disVeke=+1V对时间求导并有36ee=，362233disdeFFm=+，利用式(6)，有 211 6Vk e (8)由(8)可知，363,dise e是有界的，由 Babalat 引理20，可知6e是有限时间收敛的。证明完毕。刘志民 DOI:10.12677/pm.2023.1310321 3109 理论数学 4.仿真结果仿真结果 水面船舶的系统参数为 2112233112233250 kg,255kg,220 kg,0.4 kg/s,0.4 kg/s,0.001kg m/smmmddd=螺旋桨推进器的推力为12000N2000Nt，最大扭矩为3100 N m100 N mt。参考轨迹设置如下。500cos,500sin,3m/s,0 m/s,1rad/s2ddddddxt yttuvr=+=初始条件为 ()()()()()()0500 m0500 m0,0,0 m/s00 m/s,00 rad/s2xuvr=其他控制参数选择为 12345672,8,3,0.8,1.2,0.8,1,0.8,6.kkkkkkk=在 MATLAB-SIMULINK 程序中按照设定的增益运行仿真程序，误差的收敛情况如下图 2。Figure 2.Error convergence diagram 图图 2.误差收敛图 5.结果分析结果分析 由仿真结果可以看出，所设计的控制算法可以实现对船舶位置和航向良好的同步跟踪控制，所设计的有限时间控制器对环境干扰具有一定的鲁棒性能，但对横向常值扰动的抗干扰能力较弱。今后的工作将重视解决这一问题。参考文献参考文献 1 Wang,N.,Sun,Z.,Yin,J.,et al.(2018)Finite-Time Observer Based Guidance and Control of Underactuated Surface Vehicles with Unknown Sideslip Angles and Disturbances.IEEE Access,6,14059-14070.https:/doi.org/10.1109/ACCESS.2018.2797084 2 Sankaranarayanan,V.and Mahindrakar,A.D.(2009)Switched Control of a Nonholonomic Mobile Robot.Communi-cations in Nonlinear Science and Numerical Simulation,14,2319-2327.https:/doi.org/10.1016/sns.2008.06.002 3 Wang,Y.,Miao,Z.,Zhong,H.and Pan,Q.(2015)Simultaneous Stabilization and Tracking of Nonholonomic Mobile Robots:A Lyapunov-Based Approach.IEEE Transactions on Control Systems Technology,23,1440-1450.https:/doi.org/10.1109/TCST.2014.2375812 刘志民 DOI:10.12677/pm.2023.1310321 3110 理论数学 4 Urakubo,T.(2015)Feedback Stabilization of a Nonholonomic System with Potential Fields Application to a Two-Wheeled Mobile Robot among Obstacles.Nonlinear Dynamics,81,1475-1487.https:/doi.org/10.1007/s11071-015-2082-5 5 Morin,P.and Samso,C.(2001)A Characterization of the Lie Algebra Rank Condition by Transverse Periodic Func-tions.SIAM Journal on Control and Optimization,40,1227-1249.https:/doi.org/10.1137/S0363012900366054 6 Fierro,R.and Lewis,F.L.(1997)Control of a Nonholonomic Mobile Robot:Backstepping Kinematics into Dynamics.Robotic System,14,149-163.https:/doi.org/10.1002/(SICI)1097-4563(199703)14:33.0.CO;2-R 7 Tanner,H.G.and Kyriakopoulos,K.J.(2002)Discontinuous Backstepping for Stabilization of Nonholonomic Mobile Robots.Proceedings of 19th IEEE International Conference on Robotics Automation,Washington DC,11-15 May 2002,3948-3953.8 Do,K.D.,Jiang,Z.P.and Pan,J.(2004)A Global Output-Feedback Controller for Simultaneous Tracking and Stabili-zation of Unicycle-Type Mobile Robots.IEEE Transactions on Automatic Control,20,589-594.https:/doi.org/10.1109/TRA.2004.825470 9 Yan,Z.,Yang,H.and Zhang,W.(2022)Robust Nonlinear Model Predictive Control of a Bionic Underwater Robot with External Disturbances.Ocean Engineering,263,Article No.111310.https:/doi.org/10.1016/j.oceaneng.2022.111310 10 张贺,姚杰,隋江华,等.基于 DSC 的欠驱动船舶路径跟踪神经滑模控制J.船舶工程,2019,41(10):85-91.11 Yang,X.,Yan,J.,Hua,C.and Guan,X.(2021)Trajectory Tracking Control of Autonomous Underwater Vehicle with Unknown Parameters and External Disturbances.IEEE Transactions on Systems,Man,and Cybernetics:Systems,51,1054-1063.https:/doi.org/10.1109/TSMC.2019.2894171 12 Wang,H.,Tian,Y.and Xu,H.(2022)Neural Adaptive Command Filtered Control for Cooperative Path Following of Multiple Underactuated Autonomous Underwater Vehicles along One Path.IEEE Transactions on Systems,Man,and Cybernetics:Systems,52,2966-2978.https:/doi.org/10.1109/TSMC.2021.3062077 13 Wang,J.,Wang,C.,Wei,Y.and Zhang,C.(2020)Neuroadaptive Sliding Mode Formation Control of Autonomous Underwater Vehicles with Uncertain Dynamics.IEEE Systems Journal,14,3325-3333.https:/doi.org/10.1109/JSYST.2019.2938315 14 Shou,Y.,Xu,B.,Zhang,A.and Mei,T.(2021)Virtual Guidance-Based Coordinated Tracking Control of Mul-ti-Autonomous Underwater Vehicles Using Composite Neural Learning.IEEE Transactions on Neural Networks and Learning Systems,32,5565-5574.https:/doi.org/10.1109/TNNLS.2021.3057068 15 Liu,X.,Zou,Y.,Meng,Z.and You,Z.(2020)Coordinated Attitude Synchronization and Tracking Control of Multiple Spacecraft over a Communication Network with a Switching Topology.IEEE Transactions on Aerospace and Elec-tronic Systems,56,1148-1162.https:/doi.org/10.1109/TAES.2019.2925512 16 Du,H.,Wen,G.,Cheng,Y.,Lu,W.and Huang,T.(2020)Designing Discrete-Time Sliding Mode Controller with Mismatched Disturbances Compensation.IEEE Transactions on Industrial Informatics,16,4109-4118.https:/doi.org/10.1109/TII.2019.2957002 17 Gu,N.,Wang,D.,Peng,Z.,et al.(2020)Adaptive Bounded Neural Network Control for Coordinated Path-Following of Networked Underactuated Autonomous Surface Vehicles under Time-Varying State-Dependent Cyber-Attack.ISA Transactions,104,212-221.https:/doi.org/10.1016/j.isatra.2018.12.051 18 Dai,S.-L.,He,S.,Wang,M.and Yuan,C.(2019)Adaptive Neural Control of Underactuated Surface Vessels with Prescribed Performance Guarantees.IEEE Transactions on Neural Networks and Learning Systems,30,3686-3698.https:/doi.org/10.1109/TNNLS.2018.2876685 19 Chen,W.,Wen,C.,Hua,S.and Sun,C.(2014)Distributed Cooperative Adaptive Identification and Control for a Group of Continuous-Time Systems with a Cooperative PE Condition via Consensus.IEEE Transactions on Automatic Control,59,91-106.https:/doi.org/10.1109/TAC.2013.2278135 20 Wang,Y.-W.,Lei,Y.,Bian,T.and Guan,Z.-H.(2020)Distributed Control of Nonlinear Multiagent Systems with Unknown and Nonidentical Control Directions via Event-Triggered Communication.IEEE Transactions on Cybernet-ics,50,1820-1832.https:/doi.org/10.1109/TCYB.2019.2908874