无人水面艇模糊自抗扰路径跟踪控制的研究与验证_刘磊.pdf

SHIP ENGINEERING 船 舶 工 程 Vol.45 No.1 2023 总第 45 卷，2023 年第 1 期 120 无人水面艇模糊自抗扰路径跟踪控制的 研究与验证无人水面艇模糊自抗扰路径跟踪控制的 研究与验证 刘 磊，范云生，沈心乐（大连海事大学 船舶电气工程学院，辽宁大连 116026）摘 要：摘 要：针对无人水面艇路径跟踪的精确控制问题，进行路径跟踪控制的研究。根据需求构建合适的无人水面艇运动数学模型，利用自抗扰控制算法，设计路径跟踪控制器，考虑到自抗扰控制中参数较为繁杂且整定不易的特点，结合模糊控制理论设计模糊自抗扰路径跟踪控制器。以大连海事大学“蓝信”号无人艇为研究对象，针对所设计的 2 种控制器进行 MATLAB 仿真试验，并使用“蓝信”号无人艇在大连星海湾大桥外海域进行实船验证试验，通过对仿真结果和试验结果的分析与对比，验证了所设计方法的可行性和有效性。关键词：关键词：无人水面艇；自抗扰控制；模糊控制；路径跟踪 中图分类号：中图分类号：U664.82;TP273 文献标志码：文献标志码：A 【DOI】10.13788/ki.cbgc.2023.01.19 Research and Verification of Fuzzy ADRC Path Following Controller for USV LIU Lei,FAN Yunsheng,SHEN Xinle (College of Marine Electrical Engineering,Dalian Maritime University,Dalian 116026,Liaoning,China)Abstract:Aiming at the precise control problem of the path following of unmanned surface vehicle(USV),the path following control is researched.An appropriate motion mathematical model of USV is constructed according to the requirements,and the path following controller is designed by the active disturbance rejection control(ADRC)algorithm.Considering the complex parameters and difficult tuning characteristics of ADRC,a fuzzy ADRC path following controller is designed by combining the fuzzy control theory.Taking Lanxin USV of Dalian Maritime University as the research object,MATLAB simulation experiments are carried out for the two controllers designed.The Lanxin USV is used to carry out a real ship verification test in the sea area outside Dalian Xingwan Bridge.Through the analysis and comparison of simulation results and experimental results,the effectiveness and feasibility of the proposed method are verified.Key words:unmanned surface vehicle(USV);active disturbance rejection control;fuzzy control;path following 0 引言引言 无人水面艇（Unmanned Surface Vehicle,USV）作为一种监测海洋环境、维护海洋权益和执行军事任务的海洋无人平台，具有广泛的应用前景，已成为了国内外智能化海洋装备的研究热点之一。但高度非线性、动态不确定和不可预测的复杂海洋环境，给欠驱动无人水面艇自主控制的精确性、稳定性、可靠性和安全性带来了严峻的挑战1-2。欠驱动无人水面艇的精细化运动控制一直是研究热点之一，其关键技术的工程化应用更是研究的难点3。自抗扰控制（Active Disturbance Rejection Control,ADRC）是韩京清4提出的一种崭新的控制方法，有 收稿日期：2021-12-10；修回日期：2022-02-24 基金项目：国家自然科学基金（61976033,51609033）；辽宁省自然科学基金（20180520005）；辽宁省重点研发指导计划（2019JH8/10100100）；大连市软科学研究计划（2019J11CY014）；中央高校基本科研业务费专项基金（3132021106,3132020110）。作者简介：刘 磊（1997），男，硕士研究生。研究方向：无人水面艇运动控制。刘磊等，无人水面艇模糊自抗扰路径跟踪控制的研究与验证 121 较为广泛的理论研究和工程应用成果5-6。CAO等7针对自抗扰控制器的参数优化问题，研究了无人艇的航向控制，在自抗扰控制器的基础上考虑到手动调节参数的繁杂，提出了自适应粒子群优化自抗扰控制器参数的方法，通过仿真验证了该策略的有效性。QIN等8针对具有非线性特性的USV航向控制，设计了基于深度置信网络的自适应自抗扰控制器，利用深度置信网络的学习能力，在线学习自抗扰中的主要控制参数，仿真结果证明该方法有效地提高了系统的控制效果。WU等9研究了船舶的航向跟踪控制问题，在自抗扰控制的基础上，引入了极值寻优算法对自抗扰航向跟踪控制器中的参数进行调整，使系统获得了更好的控制性能。XIAO等10提出了一种USV遗传算法自抗扰航向控制方法，利用遗传算法在线实时修改自抗扰控制器的参数来提高其自适应能力，仿真验证了该方法的有效性。YU等11采用多种群协同进化代替单种群进化，将自适应多种群遗传算法应用到自抗扰控制器的参数整定中，通过对无人船的航向控制进行仿真，证明了该方法可以有效地提高控制器的响应速度和控制精度。然而，多数的自抗扰控制器参数优化研究是通过理论仿真方法验证可行性，其工程应用的有效性有待进一步的验证。模糊控制在自抗扰控制器参数优化中有着独特的优势，在电机控制、飞行器控制等方面有着大量的研究成果。SU12在永磁同步电机调速系统中引入了模糊自抗扰控制方法，利用模糊控制实时调整非线性状态误差反馈的比例系数，仿真结果表明该方法相比传统的自抗扰控制具有更好的控制效果。LI等13针对水下航行器的航向控制问题，提出了一种基于自抗扰控制的模糊优化自适应控制方法，该方法实现较为简单，计算复杂度低，可在复杂海况下实现有效的控制。TAO等14使用模糊自抗扰方法进行电机系统的速度跟踪控制，用模糊规则对扩张状态观测器的参数进行调整，既保证了系统的速度跟踪性能，又提高了系统的鲁棒性。GAI等15针对永磁同步电机伺服系统，提出了模糊自抗扰位置控制器，该方法不仅减小了可调参数数量，还提高了系统的控制性能。LU等16研究了机械臂关节中的永磁同步电机伺服系统的位置控制方法，考虑到自抗扰控制中参数整定困难等因素，建立了模糊优化自抗扰自适应双环驱动系统，提高了系统的定位精度和响应速度。模糊自抗扰在船舶航向控制中也有少量的研究成果，但大都仅限于仿真验证，很少有应用到实船试验中。针对无人水面艇路径跟踪的精确控制问题，在团队研究17-21的基础上，本文提出一种模糊自抗扰的USV路径跟踪控制方法并进行仿真验证和实船验证，主要内容如下：1）考虑研究对象“蓝信”号无人艇的特性，建立了2阶欠阻尼艉机模型；2）在自抗扰路径跟踪控制器的基础上，考虑到参数较多而且整定困难，结合模糊控制设计了模糊自抗扰控制方法，能够对自抗扰中的参数进行在线整定和优化。利用MATLAB仿真对2种控制方法进行比较，证明了模糊自抗扰方法比传统的自抗扰方法具有更好的控制效果；3）为了验证所提出方法的实用性，进行实船验证，进一步证明所提出方法的实用性、有效性和优越性。1 理论分析理论分析 1.1 USV运动数学模型的建立运动数学模型的建立 本文研究的USV是欠驱动无人水面艇，为了方便研究，通常将USV的六自由度空间运动简化为三自由度的平面运动，其平面运动示意图见图1。图1 平面运动示意图 图 1 中：O0-X0Y0为惯性坐标系，O0为选取的地球上面一点作为原点，O0X0指向正北方向，O0Y0指向正东方向；o-xy 为USV 的附体坐标系，o 为选取USV的质心作为原点，ox 指向艇首的方向，oy 指向 USV的右舷方向；为漂角；为舵角；为艏摇角；22()Uuv=+为前进速度u和横漂速度v的和速度。此时 USV 的平面运动方程为()()zzm urvXm vurYI rN-=|+=|=?（1）式中：m 为USV 的质量；r 为艏摇角速度；Izz为USV相对于 z 轴的转动惯量；X、Y 和 N 分别为作用在USV的 x 轴、y 轴的水动力和 z 轴方向上的水动力矩。通过转换和求解，最终可以得到 Nomoto 数学模型为 TK+=?（2）式中：T和K为模型参数；?和?分别为的1 阶导数和2 阶导数。考虑到无人水面艇运动时的非线性特性，在Nomoto 模型中引入1 个非线性项，就可得Norrbin 模型为 船舶电气、探通导设备及自动控制 122 3TrrrKr+=?（3）式中：为非线性项模型系数。Norrbin 模型结合 USV 的运动学方程，有：3cossinsincosxuvyuvTrrrKr=-|=+|+=|=?（4）研究对象“蓝信”号无人水面艇，经辨识得到的数学模型参数K、T和分别为0.701、0.332和1.1023。1.2 艉机模型和干扰数学模型艉机模型和干扰数学模型 研究对象“蓝信”号无人水面艇的艉机模型采用式（5）22：22nnnr2P +=?（5）式中：r为指令推进角；n为自然频率；为阻尼比；P为放大系数；经辨识得到的模型参数n、和P依次为1.396、0.853 和1.0203。无人艇在复杂海况中航行时，其运动性能受外部干扰（风、浪、流）的影响较大，为此必须研究所受干扰的数学模型。为了便于计算，在无人艇运动航行控制的仿真中，将高斯白噪声通过 1 个 2 阶传递函数来模拟干扰对无人水面艇的影响：()()()y sh s w s=（6）式中：w(s)为高斯白噪声；h(s)为2阶波浪传递函数且满足：2200()2K sh sss=+（7）式中：s为传递函数中的复数变量；K为增益常数；为阻尼系数；0为主导海浪频率。2 控制器设计控制器设计 USV的路径跟踪控制可分为间接路径跟踪控制和直接路径跟踪控制。直接路径跟踪控制的控制精度较高、控制效果较好，但设计较为困难；而间接路径跟踪控制设计较为简单，易于实现。本文采用间接路径跟踪控制，利用LOS（Line-of-Sight）制导算法将航迹偏差转化为期望的航向，进而实现间接的路径跟踪控制。其控制结构见图2。图2 基于LOS制导律的间接路径跟踪控制原理图 2.1 LOS算法算法 LOS制导算法应用广泛，具有不依赖于模型对象和抗干扰能力强的特点23-24。选取USV当前的位置为P=(x,y)，以此点为圆心，选取半径为R做圆，此时会与USV前一时刻位置Pk与下一时刻位置Pk+1所在的直线上相交于2点A和B，距离Pk+1较近的点B为LOS位置，几何关系见图3。图3 LOS中的几何关系 通过图3可得到期望的航向角：222losloslosloslos()()tanxxyyRyyxx-+-=|-=|-（8）假设点P到直线P