基于变增益PID的两栖航行器控制律设计.pdf

第 51 卷收稿日期：2022年11月2日，修回日期：2022年12月17日基金项目：国防基础科研计划项目（编号：JCKY2017414C002）；江苏科技大学创新创业项目资助。作者简介：夏金铭，男，研究方向：四旋翼无人机控制技术。宋大鹏，男，硕士研究生，研究方向：控制工程与理论及其应用。孟子晗，男，研究方向：水面无人艇自主控制。仇坤，男，硕士研究生，研究方向：船舶自主避障控制。1引言水空两栖航行器一词自提出后基本上可归结为载人概念样机，因为载人两栖飞行器除了要考虑两种不同流体介质的布局、结构、驱动等兼容性要求外，还要考虑工作舱设计、生命保障系统设计及相关因素，因此具有更高的复杂性与技术难度1。随着无人系统的发展，各国将载人机转变为无人设备，使其具有无人机的高速机动和快速部署能力，以及无人艇的快速游弋能力，在军民两用方面展现出了广阔应用前景24。近年来，许多控制理论方法被应用到无人系统领域。针对四旋翼无人机，文献 5 采用串级模糊自适应PID控制算法，针对无人艇，文献 6 采用模糊自适应PID控制器进行控制，系统稳定性、快速性和准确性相比单一PID控制有了显著提升。文献 7 采用线性二次型最优控制器进行控制，文献8 提出双闭环积分滑模控制系统，增强控制器鲁棒性与抗干扰性控制精度高。文献 9 将滑模控制器与基于切换函数的扩张状态观测器设计方法所得的系统扰动估计值结合，有效抑止传统滑模控制的抖振现象，文献 10 采用自抗扰方式对四旋翼无总第 403 期2023 年第 5 期计算机与数字工程Computer&Digital EngineeringVol.51 No.5基于变增益 PID 的两栖航行器控制律设计夏金铭宋大鹏孟子晗仇坤（江苏科技大学电子信息学院镇江212000）摘要水空两栖无人航行器结合四旋翼无人机及水面无人艇的优势，实现了水空两栖作业的需求。由于空气与水体的介质特性具有显著差异，两栖航行器处于运动域过渡阶段时，航行器接触介质和运动状态的改变，使其难以实现平稳控制。针对这一问题，通过建立不同运动阶段的两栖航行器数学模型，和设计相应的控制器，基于变增益PID的控制方式以实现两栖航行器的平稳控制。仿真实验结果表明所给出的控制方法稳定、可行，能够满足航行器需求。关键词两栖航行器；控制律设计；变增益；PID控制中图分类号TP273DOI：10.3969/j.issn.1672-9722.2023.05.038Controller Design of the Aerial-water Vehicle Based onVariable Gain PIDXIA JinmingSONG DapengMENG ZihanQIU Kun（School of Electronics and Information，Jiangsu University of Science and Technology，Zhenjiang212000）AbstractWater-Aerial Vehicle combines the advantages of four-rotor UAV and Unmanned Vessel，and achieves the requirement of water-air amphibious operation.The change of the medium and motion state makes it difficult to be stable.When theamphibious vehicle is in the transitional stage of the motion domain，due to the characteristics of air and water are significantly different.In order to solve this problem，by establishing the mathematical model of the amphibious vehicle in different motion stagesand designing the corresponding controller，the stable control of the amphibious vehicle is realized based on the variable gain PIDcontrol mode.The simulation results show that the proposed control method is stable and feasible，and can meet the requirements ofthe aircraft.Key Wordsaerial-water vehicle，design of control law，variable gain，PID controlClass NumberTP27311922023 年第 5 期计算机与数字工程人机进行控制，并引入虚拟控制量对位置和姿态进行控制解耦，应用扩张状态观测器实现状态解耦和扰动估计，此控制器具有良好的解耦效果、抗干扰和鲁棒性能。然而，两栖航行器具有无人艇与无人机的非线性、强耦合等特性，其数学模型更加复杂，采用单一控制器1112难以实现平稳控制。本文主要解决两栖航行器水空介质切换时的稳定性问题。首先建立两栖航行器的数学模型，然后采用PID方法与变增益PID方法设计控制器，最后合成一个控制器，并对模型控制律进行仿真实验以验证所提方法的有效性。2两栖航行器数学建模本文研究对象如图1所示，采用船体结构与四旋翼结构结合的模式，当四旋翼作为动力输出时，两栖航行器进入飞行模式或过渡模式；当船体尾部推进器作为动力输出时，两栖航行器进入航行模式。为简化模型分析，提出以下假设13：1）两栖航行器为刚体，在运动过程中质量保持不变；2）地面坐标系视为惯性坐标系；3）地球表面是平的，且忽略自转与公转；4）重力不随高度变化而变化；5）两栖航行器关于x-z平面对称；6）飞行模式为低速飞行时忽略空气摩擦力；7）飞行模式进行低速小角度飞行。建立两栖航行器的数学模型14，惯性坐标系以及航行器坐标系如图1所示。两栖航行器的方向由横滚角、俯仰角、偏航角三个欧拉角表示。基于航行器坐标系的旋转矢量表示为=，对应的角速度矢量为=pqr；基于惯性坐标系的位置矢量表示为r=xyz，对应的线速度矢量为v=uvw。两栖航行器所受外力f=XYZ，关于原点所受外力矩为m=KMN。图1两栖航行器系统结构和坐标系根据牛顿力学与拉格朗日力学可得航行器平动方程与航行器转动方程：m(vc+vc)=fc（1）Ic +（Ic）=mc（2）式中，m表示航行器自身质量，vc=v1v2v3表示体固定参照系中的线速度，=123表示地固定参照系中的角速度，Ic表示物体的惯性张量，fc与mc表示外力重心所受的外力与外力矩。令RB=fm、=v，将式（1）和式（2）简化为式（3）：MRB+CRB()=RB（3）式中MRB表示刚体惯性矩阵，CRB()表示刚体Coriolis矩阵与向心矩阵。MRB=m000000m000000m000000Ix0-Ixz0000Iy0000-Izx0Iz（4）CRB()=0 0 00000 0 00000 0 00000 0 00-Ixzp+Izr-Iyq0 0 0Ixzp-Izr0-Ixzr+Ixp0 0 0IyqIxzr-Ixp0（5）2.1两栖航行器飞行阶段模型当两栖航行器处于飞行阶段时，只考虑其高度与姿态角的建模设计，航行器四个旋翼产生力与力矩，决定系统的控制输入量Z、K、M、N。则两栖航行器飞行阶段模型可用下式表示：M1+C1()=1（6）式中=wpqr、1=ZKMN，M1、C1()表示为M1=m0000Ix0-Ixz00Iy00-Izx0Iz（7）C1()=000000-Ixzp+Izr-Iyq0Ixzp-Izr0-Ixzr+Ixp0IyqIxzr-Ixp0（8）2.2两栖航行器航行阶段模型当两栖航行器处于航行模式时，只考虑其姿态角的建模设计，航行器两个螺旋桨产生力与力矩，决定系统的控制输入量K、M、N，航行器所受的1193第 51 卷力与力矩中包含来自水的影响所产生的外力与外力矩，即2=H+RB，其中H表示水动力与水力矩，2表示系统的控制输入量。H=-M-C()-D()（9）其中，M表示附加的质量矩阵，CA表示流体动力学Coriolis与向心矩阵，D()表示水阻尼。MA=Kp000Mq000Nr（10）CA=0-NrrMqqNrr0-Kpp-MqqKpp0（11）D()=-Kp000Mq000Nr-Kp|p|p|000Mq|q|q|000Nr|r|r|（12）由于此系统中=pqr、2=KMN，所以两栖航行器航行阶段模型可用式（13）表示：（M2+MA）+(C2()+CA()+D()=2（13）其中M2、C2()表示为M2=Ix0-Ixz0Iy0-Izx0Iz（14）C2()=0-Ixzp+Izr-IyqIxzp-Izr0-Ixzr+IxpIyqIxzr-Ixp0（15）2.3两栖航行器过渡阶段模型当两栖航行器处于过渡阶段时，两栖航行器四个旋翼产生升力使航行器上升，其附加的来自水的外力与外力矩会随其与水接触面积的改变而变化，由此可知M、C()D()与两栖航行器和水平面的相对高度h相关。当两栖航行器未离开水面时，两栖航行器模型与其航行阶段相同；当两栖航行器脱离水面时，两栖航行器模型与其飞行阶段相同，由于其输入控制量与飞行阶段输入控制量相同，则两栖航行器航行阶段模型可以表示为（M1+MA(h)）+(C1()+CA(h)+D(h)=1（16）3两栖航行器控制器设计由于两栖航行器有三种不同工作阶段，所以此处分别设计三种不同的控制器对该两栖航行器进行控制。3.1两栖航行器航行阶段控制器设计两栖航行器处于航行阶段时，通过改变尾部的两个电动机的转速来调节两个螺旋桨的转速，进而改变推力，当两个电机转速相同时，推动两栖航行器前进；当两个电机转速存在差异时，两栖航行器做偏航运动，两栖航行器顶端四旋翼提供升力进行横滚角度以及俯仰角度控制，稳定航行器。控制量2=KwMwNw，采用航行阶段横滚角控制器、俯仰角控制器与偏航角控制器对其横滚角、俯仰角与偏航角进行控制。当两栖航行器处于航行阶段时，根据上述两栖航行器航行阶段的模型，可得其航行阶段数学模型表达式：p=Iz1K1+IzxN1q=M1Iy1r=Ix1N1+IzxK1（17）式 中=Iz1Ix1-I2zx，K1=Kw+Kp*p+Kp|p|p|*p，N1=Nw+Nr*r+Nr|r|r|*r，Ix1=Ix-Kp，Iz1=Iz-Kr。由此设计两栖航行器航行阶段控制器，此处采用PID控制器对其进行控制1516：T=KPae+KIa(e)dt+KDae（18）式中T为航行阶段的输入，e表示各通道误差，KPa为PID控制器比例系数，KIa为PID控制器积分系数，KDa为PID控制器微分系数。3.2两栖航行器飞行阶段控制器设计两栖航行器处于飞行阶段时，可以视其为四旋翼无人机结构。通过调节4个旋翼的转速使产生的升力发生变化，当4个旋翼转速相同时，两栖航行器垂直升；当旋翼转速存在差异时，两栖航行器做横滚、俯仰或者偏航运动，从而实现对两栖航行器高度h、横滚角、俯仰角、偏航角的控制。飞行阶段的近似线性化模型表明，两栖航行器高度h、横滚角、俯仰角、偏航角四个通道相互独立，因此可以对这4个独立的姿态控制回路分别设计 PID 控制器。设飞行阶段高度h、翻滚角、俯仰角与偏航角的控制量为1=ZaKaMaNa。根据上述飞行阶段模型，取=IzIx-I2zx得其飞行阶段数学模型表达式：夏金铭等：基于变增益PID的两栖航行器控制律设计11942023 年第 5 期计算机与数字工程z=Zamcoscos-g =IzKa+IzxNa=MaIy =IxNa+IzxKa（19）3.3两栖航行器水空过渡阶段控制器设计当两栖航行器处于水空过渡阶段时，航行器停止对螺旋桨的控制，转而对飞行旋翼进行控制。该阶段两栖航行器仅改变高度，采用高度控制器进行控制，姿态角控制器仅起稳定作用。式（16）表明相比于飞行阶段与航行阶段，两栖航行器的水空过渡阶段由于航行器与水接触面积的变化，会导致其扰动处于不断变化的过程中。单个PID控制器难以满足两栖航行器的控制要求，不能直接采用飞行阶段或航行阶段所使用的PID参数进行控制。本文设计了变增益PID对两栖航行器水空过渡阶段进行控制。当两栖航行器与水接触面积相同时，其扰动也相同，所以两栖航行器对于不同高度下的扰动选择不同比例系数、积分系数、微分系数实现PID控制。设水空过渡阶段高度h、翻滚角、俯仰角与偏航角的控制量为RB=ZgKgMgNg。z=Zamcoscos-g =IzK2+IzxN2=MgIy =IxN2+IzxK2（20）式 中K2=Kg+Kp(h)*p+Kp|p|(h)|p|*p，=IzIx-I2zx，N2=Ng+Nr(h)*r+Nr|r|(h)|r|*r，Ix=Ix-Kp(h)，Iy=Iy-Kq(h)，Iz=Iz-Kr(h)。3.4两栖航行器总控制器设计两栖航行器的运动状态分为航行阶段、飞行阶段以及水空过渡阶段，可以采用高度为变量，以变增益 PID的形式表示两栖航行器的 PID参数。当两栖航行器距水平面高度小于2m时，可采用表3所示的参数；当两栖航行器距水平面高度大于2m，即处于飞行模式时，可采用表2所示的参数。4仿真结果采用Matlab软件对上文中提出的模型以及算法进行仿真，取两栖航行器参数如表1所示。表1两栖航行器参数参数m/kgl mIx10-3(kg/m2)Iy10-3(kg/m2)Iz10-3(kg/m2)Ixz10-3(kg/m2)数值1.20.22.3532.1025.2621.512设两栖航行器初始高度为零，离开水面高度为2m，所受的初始外力与外力矩皆为零。根据两栖航行器航行阶段模型，设计两栖航行器航行阶段控制器，由表 1 参数，取式（17）和式（18），得到如表2所示的PID参数。表2两栖航行器航行阶段PID参数KP、KI、KD-51、-5.5、-10KP、KI、KD60、9、83KP、KI、KD-14、-0.2、-7根据两栖航行器飞行阶段模型，设计两栖航行器飞行阶段控制器，由表 1 参数，取式（18）和式（19），得到如表3所示的PID参数。表3两栖航行器飞行阶段PID参数KPh、KIh、KDh5、0、7.7KP、KI、KD-8、-0.1、-1KP、KI、KD1、0、2KP、KI、KD-4、-0.1、-2根据两栖航行器水空过渡阶段模型，设计两栖航行器水空过渡阶段控制器，由表 1 参数，取式（18）和式（20），取得PID参数如表4所示。表4两栖航行器水空过渡阶段PID参数h00.511.52KPh、KIh、KDh10、0、410、0、410、0、48、0、55、0、7.7KP、KI、KD-51、-5.5、-10-33、-4、-8-18、-3、-6-16、-1、-4-8、-0.1、-1KP、KI、KD60、9、8345、6、6030、3、4015、0、181、0、2KP、KI、KD-14、-0.2、-7-11、-0.1、-5-9、-0.1、-4-6、-0.1、-3-4、-0.1、-2图2为两栖航行器航行阶段对偏航角度的控制。外部输入偏航角期望角度d为30，由图2可见，在PID控制器控制下峰值时间约为6s，调节时间约为7.5s，稳态误差趋近于0。可见航行阶段偏航角度PID控制器的性能能够满足控制要求。图3为两栖航行器航行阶段对横滚角度的控制。外部输入横滚角期望角度d为30，由图3可见，在PID控制器控制下峰值时间约为6.5s，调节时间约为8s，稳态误差趋近于0。可见航行阶段横1195第 51 卷滚角度PID控制器性能能够达到对两栖航行器航行阶段横滚角控制要求。图2两栖航行器航行阶段偏航角度响应图3两栖航行器航行阶段横滚角度响应图4两栖航行器航行阶段俯仰角度响应图4为两栖航行器航行阶段俯仰角度的控制。外部输入俯仰角期望角度d为30，由图4可见，在PID控制器控制下峰值时间约为2s，调节时间约为3s，稳态误差趋近于0。可见航行阶段俯仰角度PID控制器性能能够达到对两栖航行器航行阶段俯仰角控制要求。图5图8为两栖航行器飞行阶段分别对其高度h、横滚角、俯仰角、偏航角的控制结果。进行高度控制时，设置期望高度为3，由图5可见，在PID控制器控制下峰值时间约为0.1s，调节时间约为0.1s，稳态误差趋近于0。横滚角控制时，设置期望角度为20，由图6可见，PID控制器控制下峰值时间约为2.2s，调节时间约为3.1s，稳态误差趋近于0。进行俯仰角控制时，设置期望角度为20，由图7可见，在PD控制器控制下峰值时间约为1.4s，调节时间约为1.5s，稳态误差趋近于0。进行偏航角控制时，设置期望角度为20，由图8可见，在PID控制器控制下峰值时间约为4s，调节时间约为4s，稳态误差趋近于0。图5两栖航行器飞行阶段高度响应图6两栖航行器飞行阶段横滚角度响应图7两栖航行器飞行阶段偏航角度响应图8两栖航行器飞行阶段俯仰角度响应由此可见所设计的飞行阶段PID的性能能够达到对两栖航行器飞行阶段的控制要求。图10图13为两栖航行器在水空过渡阶段对其高度的控制，高度h低于2m时，两栖航行器与水面接触，高于2m时脱离水面。将其运动过程分为5段，对高度及三个姿态角进行控制，所设比例系数、积分系数与微分系数如表4所示，采用线性拟合手段拟合成曲线如图9所示，高度h、横滚角、俯仰角、偏航角的输出如图10图13所示，高度控制时，峰值时间约为0.3s，调节时间约为4s，稳态误差趋近于 0；横滚角控制时，峰值时间约为0.6s，调节时间约为3.5s，稳态误差趋近于0；俯仰角控制时，峰值时间约为0.6s，调节时间约为5s，稳态误差趋近于0；偏航角控制时，峰值时间约为0.6s，调节时间约为6s，稳态误差趋近于0。仿真结果表明该控制器能够在两栖航行器的水空过渡阶段达到控制要求。夏金铭等：基于变增益PID的两栖航行器控制律设计11962023 年第 5 期计算机与数字工程2010000.511.52h/m（a）水空过渡阶段高度控制器PID参数KpKd500-5000.511.52h/m（b）水空过渡阶段横滚角度控制器PID参数KpKdKi10050000.511.52h/m（c）水空过渡阶段俯仰角度控制器PID参数KpKiKd0-10-2000.511.52h/m（d）水空过渡阶段偏航角度控制器PID参数KpKiKd图9两栖航行器过渡阶段各控制器参数取值曲线图10两栖航行器过渡阶段高度响应图11两栖航行器过渡阶横滚角度响应图12两栖航行器过渡阶俯仰角度响应图13两栖航行器过渡阶段偏航角度响应5结语本文针对水空两栖无人航行器运动状态切换稳定控制的需求，设计了一种基于变增益PID控制律的控制方法，通过检测不同高度判断两栖航行器接触介质的程度，配置相应的PID参数。相比单一经典PID控制，该控制器稳定性、响应速度均能更好满足两栖航行器在水空两栖的稳定作业要求。利用 Matlab软件在 Simulink环境中搭建两栖航行器控制仿真模块，获得了较为理想的仿真结果，验证了该控制器的可行性。参 考 文 献1杨兴帮，梁建宏，文力，等.水空两栖跨介质无人飞行器研究现状 J.机器人，2018，40（01）：102-114.YANG Xingbang，LIANG Jianhong，WEN Li，et al.Research status of water air amphibious cross medium UAVJ.Robot，2018，40（01）：102-114.2Yang X，Wang T，Liang J，et al.Survey on the novel hybrid aquatic-aerial amphibious aircraft：Aquati-cunmanned aerial vehicle（Aqua UAV）J.Progress in Aerospace Sciences，2015，74：131-151.3Department of Defense.FY2013-2038 unmanned systemsintegrated roadmap M.Washington，USA：Departmentof Defense，2013.4Murphy R R，Steimle E，Griffin C，et al.Cooperative useof unmanned sea surface and micro aerial vehicles at Hurricane WilmaJ.Journal of Field Robotics，2008，25（3）：164-180.5于文妍，杨坤林.四旋翼无人机串级模糊自适应PID控制系统设计 J.机械设计与制造，2019（01）：227-231.YU Wenyan，YANG Kunlin.Design of cascade fuzzyadaptive PID control system for quadrotor UAVJ.MechanicalDesignandManufacturing，2019（01）：227-231.6王健，王承龙，李智，等.基于自适应模糊PID的四旋翼飞行器悬停控制 J.桂林电子科技大学学报，2016，36（5）：406-411.WANG Jian，WANG Chenglong，LI Zhi，et al.Hoveringcontrol of quadrotor aircraft based on Adaptive Fuzzy PID1197第 51 卷J.Journal of Guilin University of Electronic Scienceand Technology，2016，36（5）：406-411.7Fan B，Sun J，Yu Y.A LQR controller for a quadrotor：Design and experiment C/Youth Academic Conferenceof Chinese Association of Automation.IEEE，2017.8陈增强，王辰璐，李毅，等.基于积分滑模的四旋翼飞行器控制系统设计 J.系统仿真学报，2015，27（09）：2181-2186.CHEN Qiangqiang，WANG Chenlu，LI Yi，et al.Designof control system for quadrotor aircraft based on integralsliding modeJ.Journal of System Simulation，2015，27（09）：2181-2186.9吴琛，苏剑波.四旋翼飞行器的轨迹跟踪抗干扰控制J.控制理论与应用，2016，33（11）：1422-1430.WU Chen，SU Jianbo.Trajectory tracking anti jammingcontrol of quadrotor aircraftJ.Control Theory and Application，2016，33（11）：1422-1430.10朱家远，杨忠，许昌亮，等.四旋翼无人机自抗扰飞行控制器研究 J.应用科技，2019，46（01）：29-35，42.ZHU Jiayuan，YANG Zhong，XU Changliang，et al.Research on ADRC of quadrotor UAVJ.Applied Science and Technology，2019，46（01）：29-35，42.11王贞琪，马洁.四旋翼几种控制方法比较 J.北京信息科技大学学报（自然科学版），2016，31（02）：35-39.WANG Zhenqi，MA Jie.Comparison of several controlmethods for quadrotorJ.Journal of Beijing Universityof Information Technology（Natural Science Edition），2016，31（02）：35-39.12吴中华，贾秋玲.四旋翼几种控制方法研究 J.现代电子技术，2013，36（15）：88-90，94.WU Zhonghua，JIA Qiuling.Research on several controlmethods of quadrotorJ.Modern Electronic Technology，2013，36（15）：88-90，94.13吴森堂，费玉华.飞行控制系统 M.北京：北京航空航天大学出版社，2005：46-47.WU Sentang，FEI Yuhua.Flight control systemM.Beijing：Beijing University of Aeronautics and Astronautics Press，2005：46-47.14杨晓飞，於慧敏，孟子晗，等.一种用于辅助搜救的两栖飞行器设计 J.扬州大学学报（自然科学版），2019，22（03）：31-35.YANG Xiaofei，YU Huimin，MENG Zihan，et al.Design of an amphibious vehicle for auxiliary search andrescueJ.Journal of Yangzhou University（Natural Science Edition），2019，22（03）：31-35.15冯培晏.四旋翼无人机建模与PID控制器设计 J.工业设计，2018（6）：135-137.FENG Peiyan.Modeling and PID controller design ofquadrotor UAVJ.Industrial Design，2018（6）：135-137.16杰轩，张雷，徐清.基于PID控制方法的汽车底盘集成控制研究 J.天津职业技术师范大学学报，2014，24（2）：19-22.JIE Xuan，ZHANG Lei，XU Qing.Research on integrated control of automobile chassis based on PID controlmethodJ.Journal of Tianjin Polytechnic Normal University，2014，24（2）：19-22.12Kay W，Carreira J，Simonyan K，et al.The kinetics human action video datasetJ.ArXiv Preprint ArXiv：1705.06950，2017.13Yang C，Xu Y，Dai B，et al.Video representation learning with visual tempo consistencyJ.ArXiv PreprintArXiv：2006.15489，2020.14Gordon D，Ehsani K，Fox D，et al.Watching the worldgo by：Representation learning from unlabeled videosJ.ArXiv Preprint ArXiv：2003.07990，2020.15Kuang H，Zhu Y，Zhang Z，et al.Video contrastivelearning with global contextC/Proceedings of theIEEE/CVF International Conference on Computer Vision.Piscataway：IEEE，2021：3195-3204.16Xu D，Xiao J，Zhao Z，et al.Self-supervised spatiotemporal learning via video clip order predictionC/Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition，2019：10334-10343.17Pan T，Song Y，Yang T，et al.Videomoco：Contrastivevideo representation learning with temporally adversarialexamples C/Proceedings of the IEEE/CVF Conferenceon Computer Vision and Pattern Recognition.Piscataway：IEEE，2021：11205-11214.（上接第1178页）夏金铭等：基于变增益PID的两栖航行器控制律设计1198