CN110908278B - 一种折叠翼飞行器的动力学建模与稳定控制方法 - Google Patents
一种折叠翼飞行器的动力学建模与稳定控制方法 Download PDFInfo
- Publication number
- CN110908278B CN110908278B CN201911097748.7A CN201911097748A CN110908278B CN 110908278 B CN110908278 B CN 110908278B CN 201911097748 A CN201911097748 A CN 201911097748A CN 110908278 B CN110908278 B CN 110908278B
- Authority
- CN
- China
- Prior art keywords
- folding
- aircraft
- wing
- loop
- wing aircraft
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 59
- 230000033001 locomotion Effects 0.000 claims abstract description 36
- 230000008569 process Effects 0.000 claims abstract description 24
- 230000008878 coupling Effects 0.000 claims abstract description 3
- 238000010168 coupling process Methods 0.000 claims abstract description 3
- 238000005859 coupling reaction Methods 0.000 claims abstract description 3
- 238000009795 derivation Methods 0.000 claims abstract description 3
- 230000008859 change Effects 0.000 claims description 15
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000004088 simulation Methods 0.000 claims description 8
- 238000013519 translation Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000006870 function Effects 0.000 claims description 4
- 230000003068 static effect Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 101000879761 Homo sapiens Sarcospan Proteins 0.000 claims description 2
- 102100037329 Sarcospan Human genes 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 238000012545 processing Methods 0.000 claims description 2
- 238000003908 quality control method Methods 0.000 claims description 2
- 239000004576 sand Substances 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000002349 favourable effect Effects 0.000 claims 1
- 230000003287 optical effect Effects 0.000 claims 1
- XOOUIPVCVHRTMJ-UHFFFAOYSA-L zinc stearate Chemical compound [Zn+2].CCCCCCCCCCCCCCCCCC([O-])=O.CCCCCCCCCCCCCCCCCC([O-])=O XOOUIPVCVHRTMJ-UHFFFAOYSA-L 0.000 claims 1
- 238000005312 nonlinear dynamic Methods 0.000 abstract description 3
- 230000009471 action Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 230000000087 stabilizing effect Effects 0.000 description 2
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 description 1
- 101710163391 ADP-ribosyl cyclase/cyclic ADP-ribose hydrolase Proteins 0.000 description 1
- 241000272168 Laridae Species 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000003767 neural control Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000002787 reinforcement Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000009966 trimming Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种折叠翼飞行器的动力学建模与稳定控制方法,首先,将带有折叠翼的飞行器看作多刚体***,建立飞行器的多刚体动力学模型;其次,计算机翼折叠过程中的气动参数与折叠角之间的函数关系;再次,根据解耦条件结合飞行器的运动学方程、动力学方程和导航方程进行解耦,得到飞行器的纵向运动方程,分析飞行器动态特性;最后,将飞行器纵向非线性动力学模型中存在的非线性项、耦合项及参数时变项视为***内外总扰动,对总扰动进行实时估计和补偿,针对补偿后的***设计PD控制器,实现速度通道和高度通道的解耦控制。本发明简化了建模过程,避免了对转动惯量的求导;控制器抗干扰能力强、控制精度高,适用于多种变体飞行器的变形稳定控制。
Description
技术领域
本发明设计一种折叠翼飞行器的动力学建模与稳定控制方法,可以实现带有折叠翼飞行器的动力学建模,且能够实现机翼折叠过程中的稳定控制,可用于多种变体飞行器的稳定控制。属于变体飞行器控制技术领域。
背景技术
变体飞行器是一种能够通过改变外形,以适应不同飞行环境、改善空气动力特性的飞行器。变体飞行器主要通过变展长、变后掠、伸缩、折叠等方式来改变机翼的构型,由此完成不同的飞行任务,提高了工作效率。早在1916年美国就提出了“变形机翼”的概念,而后洛克希德.马丁公司提出折叠翼变形方案,将机翼分为内翼和外翼,通过铰链连接,折叠时内翼能够贴合到机身上,使机翼面积和后掠角大幅度变化,实现低空高速飞行,完全展开时翼面积增大2.8倍,有利于提高升力,增加航程。
机翼的折叠带来的额外自由度使得飞行器的动力学模型变得更加复杂,而由变形引起的气动力与气动力矩、压心、质心和转动惯量等参数的变化以及附加力和附加力矩的产生都会给飞行器的稳定性和操纵性带来很大的影响,严重的甚至会失稳,由此对飞行器的控制性能提出了更高的要求。
对变体飞行器进行准确的动力学建模是实现其高性能控制的前提。为此,国内外的一些研究机构已经对此开展了研究。Yue等人使用Newton-Euler方法建立了变体飞行器的六自由度非线性动力学模型,研究了飞行器的纵向动力学响应。Thomas M.Seigler等人使用Kane方法对大型变形飞机进行动力学建模,得到飞行器的非线性动力学模型。赵育善、余旭东等人使用拉格朗日法和Runge-Kutta法计算了折叠机构的运动学和动力学,分析了各种阻尼力矩和摩擦力矩对折叠机构的影响。
针对变体飞行器的控制,目前也有很多学者展开了研究。Wen等人提出了一种基于线性变参数(Linear Parameter Varying,LPV)方法有限时间收敛的滑模控制策略,用于变形飞机在参数不确定和外界干扰下的稳定性控制。Guo等人将折叠翼飞行器的非线性动力学模型简化为以折角为参数的鸥翼,设计了H∞跟踪控制器进行跟踪控制。Kenneth Boothe等人引入线性输入框架描述非线性***,设计了抗干扰控制器进行变形飞行控制。Monish.D.Tandale等人提出了一种自适应强化学习控制方法对飞行器进行跟踪控制,并验证了参数不确定和有未知扰动情况下的控制性能。Zhu等人提出了一种考虑参数不确定的复合自适应神经控制对变后掠翼过程中的姿态进行控制,解决了神经网络的约束问题。在以上控制方法中,基于LPV的变增益控制是目前较为常用的方法,但是LPV***是在小扰动情况下对模型进行线性化得到的,当飞行器进行大角度机动时,LPV***与原始***存在较大的误差,若仍采用此方法将严重影响控制精度甚至无法实现稳定控制。
发明内容
本发明的技术解决问题是:针对现有的折叠翼飞行器动力学建模与稳定控制方法中需要对模型线性化、不考虑大角度机动、控制精度低,并且难以实时对外部干扰进行估计补偿的问题,提供了一种折叠翼飞行器的动力学建模与稳定控制方法,提出针对飞行器的速度通道和高度通道分别设计扩张状态观测器进行非线性项的补偿,针对补偿后的***设计PD稳定控制器,实现速度通道和高度通道的解耦控制,具有抗干扰能力强、控制精度高等优点,可用于多种变形飞行器的稳定控制。
本发明的技术解决方案为:针对带有折叠翼的飞行器在变形过程中的飞行稳定控制***;首先,基于凯恩方法建立带有折叠翼飞行器的多刚体动力学模型,得到飞行器的平动方程和转动方程;其次,根据机翼的几何参数在折叠过程中的变化计算飞行器的气动参数与折叠角之间的函数关系;再次,根据飞行器的解耦条件对飞行器的运动方程组进行解耦,得到飞行器的纵向非线性运动方程,分析机翼折叠过程中纵向飞行参数的变化;最后,针对速度通道和高度通道分别设计基于自抗扰理论的稳定控制器,实现变形过程中的稳定控制;
本发明一种折叠翼飞行器的动力学建模与稳定控制方法,具体实施步骤如下:
步骤一、基于凯恩方法建立带有折叠翼飞行器的多刚体动力学模型,得到飞行器的平动方程和转动方程;
首先,将飞行器看做是由五个独立刚体组成的多刚体***,所述的五个独立刚体分别为机体、左折叠翼内翼、左折叠翼外翼、右折叠翼内翼、右折叠翼外翼;建立基本坐标系,包括地面坐标系fg-Oxgygzg、机体坐标系fb-Oxbybzb、速度坐标系fa-Oxayaza、折叠翼体坐标系fi(i=1,,2,3,4),其中,1表示左折叠翼内翼,2表示左折叠翼外翼,3表示右折叠翼内翼,4表示右折叠翼外翼。根据矢量求导法则,首先求取各刚体的速度矢量和加速度矢量,选取机体速度和角速度为广义速度,分别求取各刚体速度相对于广义速度的偏速度,求取凯恩方程,得到飞行器的平动方程和转动转动方程如下:
式中:vb表示机体的速度在机体坐标系下的分量列阵,在速度坐标系下表示为vb (a)=[V 0 0]T,上标a表示速度坐标系,V表示飞行速率;ωb表示机体坐标系相对于地面坐标系的角速度在机体坐标系下的分量列阵,记为ωb=[p q r]T;F表示多刚体***所受到的合外力在机体坐标系下的分量列阵,包括气动力、推力和重力;FS表示机翼折叠带来的附加力在机体坐标系下的分量列阵;I表示飞行器相对于Ob的转动惯量在fb下的投影;MA表示飞行器所受到的气动力矩在机体坐标系下的分量列阵;MS表示机体折叠带来的附加力矩在机体坐标系下的分量列阵。
附加力与附加力矩在机体坐标系下的表示为:
式中:R、rb1、rb3、r12、r34分别表示Og到Ob的位置矢量在fg下的分量列阵、Ob到O1和O3的位置矢量在fb下的分量列阵、O1到O2的位置矢量在f1下的分量列阵、O3到O4的位置矢量在f3下的分量列阵;变量上“.”表示在投影坐标系下求对时间求一阶导,变量上“..”表示在投影连坐标系下求对时间求二阶导,上标“×”表示变量的叉乘;Aij表示fj到fi的转换矩阵;Ωi、ωi分别表示fi相对于fg的角速度在fi下的分量列阵、fi相对于fb的角速度在fi下的分量列阵;Si,Ii,表示第i个机翼对Oi的静矩、转动惯量矩阵和拟惯量矩阵在fi下的投影,表示为:
Si=∫ridm
Ii=-∫ri ×ri ×dm
Sbi=mirbi+AbiSi
Ibi=-∫(rbi ×+Abiri ×Aib)(rbi ×+Abiri ×Aib)dm
式中:rbi表示Ob到Oi的位置矢量在在fb下的分量列阵;Abi表示fi到fb的转换矩阵,且有Aib=Abi T。
步骤二、根据机翼的几何参数在折叠过程中的变化计算飞行器的气动参数与折叠角之间的函数关系;
根据空气动力学可知,飞机所受到的气动力和力矩可以表示为:
其中,L、D、MAyM分别表示飞机所受到的升力、阻力、俯仰力矩;ρ表示空气密度;v表示飞行速度;Sw表示机翼的参考面积;cA表示平均气动弦长。
经过线性化之后的飞行器气动系数可表示为:
其中,CL0、CD0、Cm0分别表示基本升力系数、零升阻力系数、零升俯仰力矩系数;CLα、CDα、Cmα分别表示升力系数、阻力系数和俯仰力矩系数对迎角的导数;分别表示升力系数和俯仰力矩系数对舵偏角的导数;α、δe分别表示迎角、舵偏角;分别表示无量纲俯仰角速度、无量纲迎角变化率;Cmq、分别表示俯仰力矩系数对无量纲俯仰角速度和无量纲迎角变化率的导数。
折叠翼飞行器在变形过程中,其受到的气动力和力矩会随着折叠角变化而发生大幅变化,为了在后续控制器设计及数值仿真中准确模拟气动,需要首先计算得到不同折叠角对应的气动数据并拟合出关于折叠角的函数。DATCOM软件能够利用飞行器的外形快速得到大量气动参数,计算便捷,适用于飞行器的理论验证阶段。因此,本文使用DATCOM软件,通过改变机身外的半翼展SSPNE、理论半翼展SSPN、内翼后掠角SAVSI和内翼上反角DHDADI来实现机翼的折叠。根据DATCOM软件计算得到的参数,利用MATLAB进行参数拟合。可以得到气动参数与折叠角之间的函数关系为:
步骤三、根据飞行器的解耦条件对上述折叠翼飞行器的运动方程组进行解耦,得到飞行器的纵向非线性运动方程,分析机翼折叠过程中纵向飞行参数的变化;
首先,对飞行器的运动方程组进行解耦,利用解耦条件可以得到飞行器的纵向运动方程如下:
其次,对飞行器进行配平,当飞行器处于定直平飞时,可以得到如下配平条件:
直接针对计算出的平衡点,基于MATLAB线性拟合工具包对其进行拟合可以得到如下关系式为:
利用水平无侧滑飞行条件,将飞机解耦为纵向运动和横侧向运动,同时根据平衡点的定义增加条件:俯仰角速度q=0和俯仰角加速度后构成基准运动的条件,这样的基准运动条件将有利于飞机运动方程的线性化处理和解耦分组。
即:
根据飞行器的纵向非线性动力学方程组选取状态量和控制输入量为:
X=[ΔV Δα Δq Δθ Δh]T,U=[ΔδT Δδe]T
故可以得到线性化后的方程的系数矩阵表达式如下所示:
基于线性化后的方程,对飞行器进行动态特性分析,研究不同折叠角速度时飞行器的参数变化情况。
步骤四、针对速度通道和高度通道分别设计基于自抗扰理论的稳定控制器,实现变形过程中的稳定控制;
针对飞行器的纵向动力学方程,分别设计基于自抗扰理论的PD稳定控制器,首先,针对速度通道设计二阶ESO来估计速度通道的非线性项,针对估计后的***设计PD控制器实现速度稳定控制;其次,高度通道为内外环回路,针对高度外回路设计PID控制器,其中控制量为指令俯仰角,针对俯仰内回路设三阶ESO对俯仰通道的非线性进行估计,针对估计后的***设计PD控制器,实现俯仰角的指令控制。具体如下:
S41、根据纵向运动方程将速度通道写成以下形式:
式中:fV为非线性项,bV为控制系数,其表达式为:
bV为时变量,而要实现自抗扰控制,只需要知道bV的估计值即可,取变形前的初始值作为其估计值,即
式中:α0为初始平衡时的攻角。则速度通道等效为:
式中:fV'=fV+(bV-bV0)δT为新的总扰动形式,UV=bV0δT为等效控制量。
设计二阶ESO为:
式中:zv1是ESO对实际速度的估计,zv2是对速度通道总扰动fv'的估计。非线性函数fal(ev1,av1,δv1)的表达式为:
式中:αv1和δv1为可调参数并满足0<αv1<1,δv1>0。只要参数βv1、βv2选择合适,满足收敛和稳定条件,当其稳定时,ESO状态将满足以下收敛关系:
zv1→V,zv2→fv'
由此可知,若设计如下形式的控制量:
UV=UV0-zv2
利用估计量zv2等效补偿可将速度通道方程化为一阶线性***:
针对此一阶线性***设计PD控制器为:
式中:Vc为指令速度。
最终得到油门开度的指令控制量为
δT=(UV0-zv2)/bv0;
S42、将高度通道分为内外环,外环为高度回路,内环为俯仰角回路。高度回路中,控制量为俯仰角θ,状态量为高度,针对高度回路设计PID控制器得到指令俯仰角,作为俯仰角回路的指令输入,俯仰角回路中,控制量为舵偏角δe,针对俯仰角回路设计三阶扩ESO,利用PD反馈控制器进行指令俯仰角的稳定控制。
S421、外环高度回路中,根据纵向运动方程中的高度方程直接设计PID稳定控制器为:
式中:hc为指令速度,控制量θc将作为内回路的指令值。
S422、内环俯仰角回路中,纵向运动方程可得到俯仰角回路运动方程具有如下形式:
式中:fθ为非线性项,bθ为控制系数,表达式为:
为实现自抗扰控制,取bθ初始值作为其估计值,故有:
式中:V0表示初始速度。故俯仰角回路可等效为:
式中,fθ'=fθ+(bθ-bθ0)uθ为新总扰动形式,Uθ=bθ0δe为等效控制量。
S423、设计俯仰角回路的三阶ESO为:
式中:zθ1是ESO对俯仰角θ的估计,zθ2ESO对俯仰角速度q的估计,zθ3是对俯仰回路总扰动fθ'的估计。只要参数βθ1、βθ2、βθ3选择合适,满足收敛和稳定条件,当其稳定时,ESO状态将满足以下收敛关系:
zθ2→θ,zθ2→q,zθ3→fθ'
故利用估计量zθ3对俯仰回路实施动态反馈控制补偿:
Uθ=Uθ0-zθ3
则俯仰回路可化为二阶线性***:
S424、针对补偿后的二阶***设计PD反馈控制器:
式中:θc为指令速度。
最终得到舵偏角的质量控制量为:
δe=(Uθ0-zθ2)/bθ0。
本发明一种折叠翼飞行器的动力学建模与稳定控制方法,与现有的技术相比的有点在于:本发明借助ADRC理论与PD控制器相结合的方式完成了机翼折叠过程中的非线性项的同时估计与补偿问题,直接针对非线性模型设计控制器,避免了传统飞行控制中的模型线性化问题,克服了传统控制方式只能用于小扰动情况下的局限性,可用于多种变体飞行器变形过程中的稳定控制。
附图说明
图1为本发明中机翼折叠示意图;
图2为本发明中在控制器作用下速度的仿真结果图;
图3为本发明中在控制器作用下高度的仿真结果图;
图4为本发明在控制器作用下的油门开度仿真结果图;
图5为本发明在控制器作用下的舵偏角仿真结果图;
图6为本发明中速度通道非线性项的实际值与估计值的对比仿真结果图;
图7为本发明中俯仰角回路非线性项的实际值与估计值的对比仿真结果图;
图8为本发明方法整体流程框图(已作为摘要附图)。
具体实施方式
下面结合附图及实施例对本发明进一步详细说明。
如图8所示,本发明提出的一种折叠翼飞行器的动力学建模与稳定控制方法,具体实施步骤如下:
(1)将折叠翼飞行器的物理模型进行简化
如图1所示,将折叠翼飞行器看做由五个独立刚体组成的多刚体***,各刚体质量分别为mi(i=b,1,2,3,4),其中,b表示机体、1表示左折叠翼内翼、2表示左折叠翼外翼、3表示右折叠翼内翼、4表示右折叠翼外翼,在折叠过程中。折叠翼内翼相对机体折叠,折叠翼外翼相对机体保持水平。
(2)建立基本坐标系
建立基本坐标系,分别为地面坐标系fg-Oxgygzg、机体坐标系fb-Oxbybzb、速度坐标系fa-Oxayaza、折叠翼体坐标系fi(i=1,,2,3,4)。
(3)各刚体的速度与加速度的求取
(4)广义速度的选取与偏速度的求取
(5)Kane方程的求取
根据所求得的偏速度与加速度求取Kane方程,可得到折叠翼飞行器的平动方程和转动方程。
(6)纵向运动方程的解耦
根据解耦条件将飞行器的平动方程与转动方程进行解耦,得到飞行器的纵向运动方程,并对其进行线性化,得到线性化后的纵向运动方程进行动态特性分析。
(7)速度通道控制器的设计
如图2所示,根据纵向运动方程将速度通道写成非线性仿射形式,其中状态量为速度V,控制量为舵偏角δT,针对速度通道设计三阶ESO对非线性项进行估计补偿,补偿后的速度通道可等效为一个一阶***,针对这个一阶***设计PD控制器,实现变形过程中的速度控制。
(8)高度通道控制器的设计
根据纵向运动方程针对高度通道设计内外环控制,高度回路为外环,状态量为高度h,控制量为俯仰角θ,直接针对高度外回路设计PID控制器,得到指令俯仰角θc;针对俯仰角回路设计三阶ESO对俯仰角回路的非线性项进行估计补偿,补偿后的俯仰角回路可以等效为一个二阶***,针对这个二阶***设计PD控制器,实现指令俯仰角的跟踪控制。
实施例一:
对于图1中所示的折叠翼飞行器,根据上述发明提供的动力学建模的具体步骤,建立折叠翼飞行器的动力学模型,该飞行器的具体参数如下表1:
表1
变形过为:在50s时使机翼以6°/s的角速度折叠60°,其中,内翼相对机体折叠,外翼相对机体始终保持水平。给定飞行器的指令速度和指令高度,选取控制参数如下表2:
表2
图3给出了控制器作用下飞行器的速度变化,从图中可以看出,变形开始时,速度会有一个小幅度的增加,变形结束后,在控制器的作用下,速度能够恢复到指令速度值。
图4给出了控制器作用下飞行器的俯仰角变化,从图中可以看出,变形开始时,俯仰角减小,变形结束后,俯仰角较之原来的稳定水平有一定的降低。
图5给出了控制器作用下飞行器的高度变化,从图中可以看出,变形开始时,高度会有一个小幅度的减小,变形结束后,高度恢复到指令高度值。
图6和图7给出了自抗扰控制器中速度通道的非线性项与俯仰角通道的非线性项的估计值与实际值的比较,从图中可以看出,速度通道与俯仰角通道的估计非线性项都能够很好地跟踪上实际非线性项。
Claims (6)
1.一种折叠翼飞行器的动力学建模与稳定控制方法,其特征在于:步骤如下:
步骤一、基于凯恩方法建立带有折叠翼飞行器的多刚体动力学模型,得到折叠翼飞行器的平动方程和转动方程;
步骤二、根据机翼的几何参数在折叠过程中的变化计算飞行器的气动参数与折叠角之间的函数关系;
步骤三、根据折叠翼飞行器的解耦条件对折叠翼飞行器的运动方程组进行解耦,得到折叠翼飞行器的纵向非线性运动方程,分析机翼折叠过程中纵向飞行参数的变化;
步骤四、针对速度通道和高度通道分别设计基于自抗扰理论的PD稳定控制器,实现变形过程中的稳定控制;
首先,针对速度通道设计二阶ESO来估计速度通道的非线性项,针对估计后的***设计PD控制器实现速度稳定控制;其次,高度通道为内外环回路,针对高度外回路设计PID控制器,其中控制量为指令俯仰角,针对俯仰内回路设计三阶ESO对俯仰通道的非线性进行估计,针对估计后的***设计PD控制器,实现俯仰角的指令控制;
所述步骤一的具体过程如下:首先,将折叠翼飞行器看做是由五个独立刚体组成的多刚体***,所述的五个独立刚体分别为机体、左折叠翼内翼、左折叠翼外翼、右折叠翼内翼、右折叠翼外翼;建立基本坐标系,包括地面坐标系fg-Ogxgygzg、机体坐标系fb-Obxbybzb、速度坐标系fa-Oaxayaza、折叠翼体坐标系fi,i=1,2,3,4;其中,1表示左折叠翼内翼,2表示左折叠翼外翼,3表示右折叠翼内翼,4表示右折叠翼外翼;根据矢量求导法则,首先求取各刚体的速度矢量和加速度矢量,选取机体速度和角速度为广义速度,分别求取各刚体速度相对于广义速度的偏速度,求取凯恩方程,得到折叠翼飞行器的平动方程和转动方程如下:
式中:vb表示机体的速度在机体坐标系下的分量列阵,在速度坐标系下表示为vb (a)=[V0 0]T,上标a表示速度坐标系,V表示飞行速率;ωb表示机体坐标系相对于地面坐标系的角速度在机体坐标系下的分量列阵,记为ωb=[p q r]T;F表示多刚体***所受到的合外力在机体坐标系下的分量列阵,包括气动力、推力和重力;FS表示机翼折叠带来的附加力在机体坐标系下的分量列阵;I表示折叠翼飞行器相对于Ob的转动惯量在fb下的投影;MA表示折叠翼飞行器所受到的气动力矩在机体坐标系下的分量列阵;MS表示机体折叠带来的附加力矩在机体坐标系下的分量列阵。
2.根据权利要求1所述的一种折叠翼飞行器的动力学建模与稳定控制 方法,其特征在于;所述机翼折叠带来的附加力与机体折叠带来的附加力矩在机体坐标系下的表示为:
式中:R、rb1、rb3、r12、r34分别表示Og到Ob的位置矢量在fg下的分量列阵、Ob到O1的位置矢量在fb下的分量列阵、Ob到O3的位置矢量在fb下的分量列阵、O1到O2的位置矢量在f1下的分量列阵、O3到O4的位置矢量在f3下的分量列阵;变量上“.”表示在投影坐标系下求对时间求一阶导,变量上“..”表示在投影坐标系下求对时间求二阶导,上标“×”表示变量的叉乘;Aij表示fj到fi的转换矩阵;Ωi、ωi分别表示fi相对于fg的角速度在fi下的分量列阵、fi相对于fb的角速度在fi下的分量列阵;Si,Ii,表示第i个机翼对Oi的静矩、转动惯量矩阵和拟惯量矩阵在fi下的投影,表示为:
Si=∫ridm
Ii=-∫ri ×ri ×dm
Sbi=mirbi+AbiSi
Ibi=-∫(rbi ×+Abiri ×Aib)(rbi ×+Abiri ×Aib)dm
式中:rbi表示Ob到Oi的位置矢量在在fb下的分量列阵;Abi表示fi到fb的转换矩阵,且有Aib=Abi T。
3.根据权利要求2所述的一种折叠翼飞行器的动力学建模与稳定控制方法,其特征在于:所述步骤二的具体过程如下:
根据空气动力学可知,折叠翼飞行器所受到的气动力和力矩表示为:
其中,L、D、MAy分别表示折叠翼飞行器所受到的升力、阻力、俯仰力矩;ρ表示空气密度;v表示飞行速度;Sw表示机翼的参考面积;cA表示平均气动弦长;
经过线性化之后的折叠翼飞行器气动系数表示为:
其中,CL0、CD0、Cm0分别表示基本升力系数、零升阻力系数、零升俯仰力矩系数;CLα、CDα、Cmα分别表示升力系数、阻力系数和俯仰力矩系数对迎角的导数;分别表示升力系数和俯仰力矩系数对舵偏角的导数;α、δe分别表示迎角、舵偏角;分别表示无量纲俯仰角速度、无量纲迎角变化率;Cmq、分别表示俯仰力矩系数对无量纲俯仰角速度和无量纲迎角变化率的导数;
折叠翼飞行器在变形过程中,其受到的气动力和力矩会随着折叠角变化而发生大幅变化,为了在后续控制器设计及数值仿真中准确模拟气动,需要首先计算得到不同折叠角对应的气动数据并拟合出关于折叠角的函数;使用DATCOM软件,通过改变机身外的半翼展SSPNE、理论半翼展SSPN、内翼后掠角SAVSI和内翼上反角DHDADI来实现机翼的折叠;根据DATCOM软件计算得到的参数,利用MATLAB进行参数拟合;得到气动参数与折叠角之间的函数关系为:
4.根据权利要求3所述的一种折叠翼飞行器的动力学建模与稳定控制方法,其特征在于:所述步骤三的具体过程如下:
首先,对折叠翼飞行器的运动方程组进行解耦,利用解耦条件得到折叠翼飞行器的纵向运动方程如下:
其次,对折叠翼飞行器进行配平,当折叠翼飞行器处于定直平飞时,得到如下配平条件:
直接针对计算出的平衡点,对其进行拟合得到如下关系式为:
利用水平无侧滑飞行条件,将折叠翼飞行器解耦为纵向运动和横侧向运动,同时根据平衡点的定义增加条件:俯仰角速度q=0和俯仰角加速度后构成基准运动的条件,这样的基准运动条件将有利于折叠翼飞行器运动方程的线性化处理和解耦分组;即:
根据折叠翼飞行器的纵向非线性动力学方程组选取状态量和控制输入量为:
X=[ΔV Δα Δq Δθ Δh]T,U=[ΔδT Δδe]T
故得到线性化后的方程的系数矩阵表达式如下所示:
5.根据权利要求4所述的一种折叠翼飞行器的动力学建模与稳定控制方法,其特征在于:所述步骤四的具体过程如下:
S41、根据纵向运动方程将速度通道写成以下形式:
式中:fV为非线性项,bV为控制系数,其表达式为:
bV为时变量,而要实现自抗扰控制,只需要知道bV的估计值即可,取变形前的初始值作为其估计值,即
式中:α0为初始平衡时的攻角;则速度通道等效为:
式中:fV'=fV+(bV-bV0)δT为新的总扰动形式,UV=bV0δT为等效控制量;
设计二阶ESO为:
式中:zv1是ESO对实际速度的估计,zv2是对速度通道总扰动fv'的估计;非线性函数fal(ev1,av1,δv1)的表达式为:
式中:αv1和δv1为可调参数并满足0<αv1<1,δv1>0;只要参数βv1、βv2选择合适,满足收敛和稳定条件,当其稳定时,ESO状态将满足以下收敛关系:
zv1→V,zv2→fv'
由此可知,若设计如下形式的控制量:
UV=UV0-zv2
利用估计量zv2等效补偿将速度通道方程化为一阶线性***:
针对此一阶线性***设计PD控制器为:
式中:Vc为指令速度;
最终得到油门开度的指令控制量为
δT=(UV0-zv2)/bv0;
S42、将高度通道分为内外环,外环为高度回路,内环为俯仰角回路;高度回路中,控制量为俯仰角θ,状态量为高度,针对高度回路设计PID控制器得到指令俯仰角,作为俯仰角回路的指令输入,俯仰角回路中,控制量为舵偏角δe,针对俯仰角回路设计三阶扩ESO,利用PD反馈控制器进行指令俯仰角的稳定控制。
6.根据权利要求5所述的一种折叠翼飞行器的动力学建模与稳定控制方法,其特征在于:所述步骤S42的具体过程如下:
S421、外环高度回路中,根据纵向运动方程中的高度方程直接设计PID稳定控制器为:
式中:hc为指令速度,控制量θc将作为内回路的指令值;
S422、内环俯仰角回路中,纵向运动方程得到俯仰角回路运动方程具有如下形式:
式中:fθ为非线性项,bθ为控制系数,表达式为:
为实现自抗扰控制,取bθ初始值作为其估计值,故有:
式中:V0表示初始速度;故俯仰角回路等效为:
式中,fθ'=fθ+(bθ-bθ0)uθ为新总扰动形式,Uθ=bθ0δe为等效控制量;
S423、设计俯仰角回路的三阶ESO为:
式中:zθ1是ESO对俯仰角θ的估计,zθ2ESO对俯仰角速度q的估计,zθ3是对俯仰回路总扰动fθ'的估计;只要参数βθ1、βθ2、βθ3选择合适,满足收敛和稳定条件,当其稳定时,ESO状态将满足以下收敛关系:
zθ2→θ,zθ2→q,zθ3→fθ'
故利用估计量zθ3对俯仰回路实施动态反馈控制补偿:
Uθ=Uθ0-zθ3
则俯仰回路化为二阶线性***:
S424、针对补偿后的二阶***设计PD反馈控制器:
式中:θc为指令速度;
最终得到舵偏角的质量控制量为:
δe=(Uθ0-zθ2)/bθ0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911097748.7A CN110908278B (zh) | 2019-11-12 | 2019-11-12 | 一种折叠翼飞行器的动力学建模与稳定控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911097748.7A CN110908278B (zh) | 2019-11-12 | 2019-11-12 | 一种折叠翼飞行器的动力学建模与稳定控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110908278A CN110908278A (zh) | 2020-03-24 |
CN110908278B true CN110908278B (zh) | 2021-05-25 |
Family
ID=69817216
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911097748.7A Active CN110908278B (zh) | 2019-11-12 | 2019-11-12 | 一种折叠翼飞行器的动力学建模与稳定控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110908278B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111767681B (zh) * | 2020-05-13 | 2023-10-13 | 中北大学 | 战术导弹纵向二次折叠翼动力学建模方法 |
CN111931292B (zh) * | 2020-08-07 | 2022-05-03 | 北京航空航天大学 | 一种翼尖铰接组合式飞行平台飞行力学建模方法 |
CN112394739B (zh) * | 2020-10-29 | 2021-11-05 | 南京航空航天大学 | 主动变形四旋翼飞行器自抗扰飞行控制方法 |
CN112558623B (zh) * | 2020-12-04 | 2024-03-15 | 天津大学 | 一种弹性高超声速飞行器多胞lpv***建模方法 |
CN114036628B (zh) * | 2021-02-14 | 2023-07-14 | 西北工业大学 | 变体飞行器翼展与控制策略协同设计方法 |
CN113051662B (zh) * | 2021-03-10 | 2024-04-02 | 南京航空航天大学 | 一种基于cfd和datcom的折叠翼尖变体飞行器的气动建模及其性能评估方法 |
CN113221479B (zh) * | 2021-05-08 | 2022-02-01 | 北京航空航天大学 | 一种考虑降雨天气的无人机动力学建模方法 |
CN113504729B (zh) * | 2021-07-23 | 2022-07-29 | 上海交通大学 | 基于lmi的仿生扑翼飞行器h∞鲁棒控制方法及*** |
CN114912202A (zh) * | 2022-05-24 | 2022-08-16 | 大连理工大学 | 宽速域吸气式动力飞行器机体推进一体化耦合控制方法 |
CN115659523B (zh) * | 2022-12-27 | 2023-03-10 | 北京航空航天大学 | 一种大展弦比无人机刚柔耦合建模分析方法 |
CN116090097B (zh) * | 2022-12-30 | 2024-07-09 | 北京机电工程研究所 | 基于等效撞水设计的近水面流固耦合有限元高效计算方法 |
CN115983014B (zh) * | 2023-01-05 | 2024-02-13 | 北方工业大学 | 基于几何强约束的单转轴升力裕度飞行器可调翼设计方法 |
CN116540553B (zh) * | 2023-07-05 | 2023-08-25 | 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) | 一种基于强化学习的移动机器人安全运动方法 |
CN117852322B (zh) * | 2024-03-08 | 2024-05-10 | 西北工业大学深圳研究院 | 一种基于虚功率原理的变体飞行器动力学建模方法及装置 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101578584A (zh) * | 2005-09-19 | 2009-11-11 | 克利夫兰州立大学 | 控制器、观测器及其应用 |
CN103019091A (zh) * | 2012-12-20 | 2013-04-03 | 北京航空航天大学 | 一种基于线性扩张状态观测器的柔性航天器容错姿态控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106873611A (zh) * | 2017-01-22 | 2017-06-20 | 北京航空航天大学 | 一种多通道线性自抗扰控制器的设计方法 |
CN108196563A (zh) * | 2018-02-09 | 2018-06-22 | 深圳禾苗通信科技有限公司 | 一种多旋翼无人机自抗扰补偿控制方法及*** |
CN108663940A (zh) * | 2018-08-20 | 2018-10-16 | 西北工业大学 | 基于集总复合估计的飞行器神经网络学习控制方法 |
CN108803310A (zh) * | 2018-07-23 | 2018-11-13 | 广东工业大学 | 一种pid控制方法、装置及设备 |
WO2019012523A1 (en) * | 2017-07-10 | 2019-01-17 | Israel Aerospace Industries Ltd. | FUEL REFUELING DEVICE |
CN109507890A (zh) * | 2019-01-09 | 2019-03-22 | 中南大学 | 一种基于eso的无人机动态逆广义预测控制器 |
CN110320794A (zh) * | 2019-07-24 | 2019-10-11 | 西北工业大学 | 基于干扰观测的弹性飞行器奇异摄动复合学习控制方法 |
-
2019
- 2019-11-12 CN CN201911097748.7A patent/CN110908278B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101578584A (zh) * | 2005-09-19 | 2009-11-11 | 克利夫兰州立大学 | 控制器、观测器及其应用 |
CN103019091A (zh) * | 2012-12-20 | 2013-04-03 | 北京航空航天大学 | 一种基于线性扩张状态观测器的柔性航天器容错姿态控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106873611A (zh) * | 2017-01-22 | 2017-06-20 | 北京航空航天大学 | 一种多通道线性自抗扰控制器的设计方法 |
WO2019012523A1 (en) * | 2017-07-10 | 2019-01-17 | Israel Aerospace Industries Ltd. | FUEL REFUELING DEVICE |
CN108196563A (zh) * | 2018-02-09 | 2018-06-22 | 深圳禾苗通信科技有限公司 | 一种多旋翼无人机自抗扰补偿控制方法及*** |
CN108803310A (zh) * | 2018-07-23 | 2018-11-13 | 广东工业大学 | 一种pid控制方法、装置及设备 |
CN108663940A (zh) * | 2018-08-20 | 2018-10-16 | 西北工业大学 | 基于集总复合估计的飞行器神经网络学习控制方法 |
CN109507890A (zh) * | 2019-01-09 | 2019-03-22 | 中南大学 | 一种基于eso的无人机动态逆广义预测控制器 |
CN110320794A (zh) * | 2019-07-24 | 2019-10-11 | 西北工业大学 | 基于干扰观测的弹性飞行器奇异摄动复合学习控制方法 |
Non-Patent Citations (4)
Title |
---|
基于扩张状态观测器的变形机翼抗饱和控制;王青等;《***工程与电子技术》;20190331;第41卷(第3期);第619-625页 * |
折叠翼飞机变体飞行建模及综合控制设计;张响阳等;《第36届中国控制会议论文集(C)》;20170731;第4706-4712页 * |
折叠翼飞行器气动建模及变形稳定控制律设计;刘玮等;《电子设计工程》;20140430;第22卷(第8期);第1-4页 * |
超低空重装空投纵向自抗扰控制;赵世伟等;《火力与指挥控制》;20170430;第42卷(第4期);第6-9、13页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110908278A (zh) | 2020-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110908278B (zh) | 一种折叠翼飞行器的动力学建模与稳定控制方法 | |
CN109614633B (zh) | 一种复合式旋翼飞行器非线性建模及线性化配平方法 | |
CN109062052B (zh) | 基于扩张状态观测器的四旋翼无人机积分滑模控制方法 | |
CN109460596B (zh) | 一种飞翼无人机非线性载荷计算方法 | |
CN111665857B (zh) | 基于复合智能学习的变体飞行器控制方法 | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN109189087B (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
CN109426146A (zh) | 高超声速飞行器的高阶非奇异Terminal滑模控制方法 | |
Zhao et al. | Multibody dynamic approach of flight dynamics and nonlinear aeroelasticity of flexible aircraft | |
CN111984020B (zh) | 基于sdre的倾转四旋翼无人机过渡飞行模式自适应最优滑模控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN112578805B (zh) | 一种旋翼飞行器的姿态控制方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂*** | |
CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN108762098B (zh) | 基于复合学习的非最小相位飞行器神经网络控制方法 | |
CN115556111A (zh) | 基于变惯性参数建模的飞行机械臂耦合扰动控制方法 | |
CN114721266A (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
CN112327629B (zh) | 基于动态补偿的小型无人直升机自适应容错控制方法 | |
CN109634110B (zh) | 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法 | |
CN117289598B (zh) | 一种飞行器的反步滑模控制方法及*** | |
CN116088549B (zh) | 一种尾座式垂直起降无人机姿态控制方法 | |
CN113580127A (zh) | 一种多旋翼飞行器仿人双机械臂***及其动态自平衡控制设计方法 | |
CN115729264A (zh) | 一种基于柔性自适应翼梢小翼的变稳隐身飞机控制方法 | |
CN116360258A (zh) | 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |