基于变增益PID的两栖航行器控制律设计.pdf
《基于变增益PID的两栖航行器控制律设计.pdf》由会员分享,可在线阅读,更多相关《基于变增益PID的两栖航行器控制律设计.pdf(7页珍藏版)》请在咨信网上搜索。
1、第 51 卷收稿日期:2022年11月2日,修回日期:2022年12月17日基金项目:国防基础科研计划项目(编号:JCKY2017414C002);江苏科技大学创新创业项目资助。作者简介:夏金铭,男,研究方向:四旋翼无人机控制技术。宋大鹏,男,硕士研究生,研究方向:控制工程与理论及其应用。孟子晗,男,研究方向:水面无人艇自主控制。仇坤,男,硕士研究生,研究方向:船舶自主避障控制。1引言水空两栖航行器一词自提出后基本上可归结为载人概念样机,因为载人两栖飞行器除了要考虑两种不同流体介质的布局、结构、驱动等兼容性要求外,还要考虑工作舱设计、生命保障系统设计及相关因素,因此具有更高的复杂性与技术难度1
2、。随着无人系统的发展,各国将载人机转变为无人设备,使其具有无人机的高速机动和快速部署能力,以及无人艇的快速游弋能力,在军民两用方面展现出了广阔应用前景24。近年来,许多控制理论方法被应用到无人系统领域。针对四旋翼无人机,文献 5 采用串级模糊自适应PID控制算法,针对无人艇,文献 6 采用模糊自适应PID控制器进行控制,系统稳定性、快速性和准确性相比单一PID控制有了显著提升。文献 7 采用线性二次型最优控制器进行控制,文献8 提出双闭环积分滑模控制系统,增强控制器鲁棒性与抗干扰性控制精度高。文献 9 将滑模控制器与基于切换函数的扩张状态观测器设计方法所得的系统扰动估计值结合,有效抑止传统滑模
3、控制的抖振现象,文献 10 采用自抗扰方式对四旋翼无总第 403 期2023 年第 5 期计算机与数字工程Computer&Digital EngineeringVol.51 No.5基于变增益 PID 的两栖航行器控制律设计夏金铭宋大鹏孟子晗仇坤(江苏科技大学电子信息学院镇江212000)摘要水空两栖无人航行器结合四旋翼无人机及水面无人艇的优势,实现了水空两栖作业的需求。由于空气与水体的介质特性具有显著差异,两栖航行器处于运动域过渡阶段时,航行器接触介质和运动状态的改变,使其难以实现平稳控制。针对这一问题,通过建立不同运动阶段的两栖航行器数学模型,和设计相应的控制器,基于变增益PID的控制方
4、式以实现两栖航行器的平稳控制。仿真实验结果表明所给出的控制方法稳定、可行,能够满足航行器需求。关键词两栖航行器;控制律设计;变增益;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
5、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 tran
6、sitional 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 a
7、mphibious 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 NumberTP2731192
8、2023 年第 5 期计算机与数字工程人机进行控制,并引入虚拟控制量对位置和姿态进行控制解耦,应用扩张状态观测器实现状态解耦和扰动估计,此控制器具有良好的解耦效果、抗干扰和鲁棒性能。然而,两栖航行器具有无人艇与无人机的非线性、强耦合等特性,其数学模型更加复杂,采用单一控制器1112难以实现平稳控制。本文主要解决两栖航行器水空介质切换时的稳定性问题。首先建立两栖航行器的数学模型,然后采用PID方法与变增益PID方法设计控制器,最后合成一个控制器,并对模型控制律进行仿真实验以验证所提方法的有效性。2两栖航行器数学建模本文研究对象如图1所示,采用船体结构与四旋翼结构结合的模式,当四旋翼作为动力输出时
9、,两栖航行器进入飞行模式或过渡模式;当船体尾部推进器作为动力输出时,两栖航行器进入航行模式。为简化模型分析,提出以下假设13:1)两栖航行器为刚体,在运动过程中质量保持不变;2)地面坐标系视为惯性坐标系;3)地球表面是平的,且忽略自转与公转;4)重力不随高度变化而变化;5)两栖航行器关于x-z平面对称;6)飞行模式为低速飞行时忽略空气摩擦力;7)飞行模式进行低速小角度飞行。建立两栖航行器的数学模型14,惯性坐标系以及航行器坐标系如图1所示。两栖航行器的方向由横滚角、俯仰角、偏航角三个欧拉角表示。基于航行器坐标系的旋转矢量表示为=,对应的角速度矢量为=pqr;基于惯性坐标系的位置矢量表示为r=x
10、yz,对应的线速度矢量为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=m00
11、0000m000000m000000Ix0-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)
12、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-
13、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两栖航行器过渡阶段模型当两栖航行器处于过渡阶段时,两栖航行器四个旋翼产生升力使航行器上升,其附加的来自水的外力与外力矩会随其与水接触面积的改变而变化,
14、由此可知M、C()D()与两栖航行器和水平面的相对高度h相关。当两栖航行器未离开水面时,两栖航行器模型与其航行阶段相同;当两栖航行器脱离水面时,两栖航行器模型与其飞行阶段相同,由于其输入控制量与飞行阶段输入控制量相同,则两栖航行器航行阶段模型可以表示为(M1+MA(h))+(C1()+CA(h)+D(h)=1(16)3两栖航行器控制器设计由于两栖航行器有三种不同工作阶段,所以此处分别设计三种不同的控制器对该两栖航行器进行控制。3.1两栖航行器航行阶段控制器设计两栖航行器处于航行阶段时,通过改变尾部的两个电动机的转速来调节两个螺旋桨的转速,进而改变推力,当两个电机转速相同时,推动两栖航行器前进;
15、当两个电机转速存在差异时,两栖航行器做偏航运动,两栖航行器顶端四旋翼提供升力进行横滚角度以及俯仰角度控制,稳定航行器。控制量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
16、控制器对其进行控制1516:T=KPae+KIa(e)dt+KDae(18)式中T为航行阶段的输入,e表示各通道误差,KPa为PID控制器比例系数,KIa为PID控制器积分系数,KDa为PID控制器微分系数。3.2两栖航行器飞行阶段控制器设计两栖航行器处于飞行阶段时,可以视其为四旋翼无人机结构。通过调节4个旋翼的转速使产生的升力发生变化,当4个旋翼转速相同时,两栖航行器垂直升;当旋翼转速存在差异时,两栖航行器做横滚、俯仰或者偏航运动,从而实现对两栖航行器高度h、横滚角、俯仰角、偏航角的控制。飞行阶段的近似线性化模型表明,两栖航行器高度h、横滚角、俯仰角、偏航角四个通道相互独立,因此可以对这4个
17、独立的姿态控制回路分别设计 PID 控制器。设飞行阶段高度h、翻滚角、俯仰角与偏航角的控制量为1=ZaKaMaNa。根据上述飞行阶段模型,取=IzIx-I2zx得其飞行阶段数学模型表达式:夏金铭等:基于变增益PID的两栖航行器控制律设计11942023 年第 5 期计算机与数字工程z=Zamcoscos-g =IzKa+IzxNa=MaIy =IxNa+IzxKa(19)3.3两栖航行器水空过渡阶段控制器设计当两栖航行器处于水空过渡阶段时,航行器停止对螺旋桨的控制,转而对飞行旋翼进行控制。该阶段两栖航行器仅改变高度,采用高度控制器进行控制,姿态角控制器仅起稳定作用。式(16)表明相比于飞行阶段
18、与航行阶段,两栖航行器的水空过渡阶段由于航行器与水接触面积的变化,会导致其扰动处于不断变化的过程中。单个PID控制器难以满足两栖航行器的控制要求,不能直接采用飞行阶段或航行阶段所使用的PID参数进行控制。本文设计了变增益PID对两栖航行器水空过渡阶段进行控制。当两栖航行器与水接触面积相同时,其扰动也相同,所以两栖航行器对于不同高度下的扰动选择不同比例系数、积分系数、微分系数实现PID控制。设水空过渡阶段高度h、翻滚角、俯仰角与偏航角的控制量为RB=ZgKgMgNg。z=Zamcoscos-g =IzK2+IzxN2=MgIy =IxN2+IzxK2(20)式 中K2=Kg+Kp(h)*p+Kp
19、|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 mIx
20、10-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)
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 增益 PID 两栖 航行 控制 设计
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。