CN111897219B - 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 - Google Patents
基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 Download PDFInfo
- Publication number
- CN111897219B CN111897219B CN202010705753.8A CN202010705753A CN111897219B CN 111897219 B CN111897219 B CN 111897219B CN 202010705753 A CN202010705753 A CN 202010705753A CN 111897219 B CN111897219 B CN 111897219B
- Authority
- CN
- China
- Prior art keywords
- rotor
- aerial vehicle
- unmanned aerial
- optimal
- coordinate system
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 230000008569 process Effects 0.000 claims description 16
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 11
- 125000004432 carbon atom Chemical group C* 0.000 claims description 10
- 238000005096 rolling process Methods 0.000 claims description 8
- 230000005484 gravity Effects 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 206010048669 Terminal state Diseases 0.000 claims description 3
- 150000001875 compounds Chemical class 0.000 claims 2
- 238000013528 artificial neural network Methods 0.000 abstract description 3
- 238000006073 displacement reaction Methods 0.000 description 9
- 230000007704 transition Effects 0.000 description 8
- 230000004044 response Effects 0.000 description 7
- 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 4
- 230000008901 benefit Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005094 computer simulation Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012887 quadratic function Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000001052 transient effect Effects 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/027—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using neural networks only
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,通过结合倾转四旋翼无人机的特点,直接针对无人机非线性模型进行控制器设计,保留了对系统有益的非线性特性,从而有效避免对模型线性化时引入的建模误差。还有的是,构建最优鲁棒性能指标,利用最优控制方法达到最优鲁棒性能指标,可以实现较强的抗干扰能力和鲁棒性能。最后,以神经网络作为在线逼近器近似最优鲁棒性能指标,用动态规划的办法得到最优鲁棒控制输入,减少了计算量,适合在线运算。
Description
技术领域
本发明涉及无人机控制的技术领域,尤其涉及到基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法。
背景技术
倾转四旋翼无人机,是一种具有四个旋翼轴的无人机,四个旋翼均可以调整方向,倾转四旋翼无人机的过渡模式是指直升机模式和固定翼飞行模式之间的相互切换过程,其既可以作为直升机来飞行,还能以固定翼飞机来飞行,将直升机的起降方便与固定翼飞机的长航程的优点融为一体,其发展和应用优势很大。
但倾转旋翼无人机被控对象特性差异显著、模型阶次高、非线性特性强、飞行模式数量多。尤其倾转四旋翼无人机在过渡模态时,存在明显的拉力矢量控制特性,三通道之间出现较强的耦合,同时还存在着气动舵面操纵与拉力矢量控制之间的协调问题,使得过渡模态下飞行控制系统设计变得更加复杂,因此倾转旋翼机过渡段的控制技术是四旋翼倾转旋翼无人机的关键难点,需要飞行控制系统实现鲁棒高抗扰的要求。
针对倾转旋翼机过渡过程的鲁棒控制研究,樊方星[樊方星,杨军.参数空间法在倾转旋翼机飞行控制系统设计中的应用[J].弹箭与制导学报,2006,26(s6):349-350.]通过对倾转旋翼机纵向通道和横向通道解耦,分别应用线性二次型最优调节器方法设计鲁棒控制器,并将参数空间的方法引入到倾转旋翼机过渡模式飞行控制中;R.K.Prasadh[Prasanth R,Mehra R,Bennett R.Active control of aeromechanical instability[C]Guidance,Navigation,and Control Conference and Exhibit.2015.]提出了一种主动控制技术方法,主要为解决倾转旋翼机的过渡模式鲁棒控制问题,其思想是利用通过线性二次型最优调节器来求解输出反馈控制器。这些方法是用配平点的线性系统近似,会带来系统建模误差,目标函数为对象状态和控制输入的线性二次型函数,没有选用非线性最优函数,只能得到次优结果。X.M.Sun[X.M.Sun,J.Zhao,D.J.Hill,Stability and L2-gainanalysis for switched delay systems:a delay-dependent method[J].Automatica2006,42(10):1769-1774.]将倾转旋翼机的过渡模式建立成为一个包含若干个子系统的切换系统,运用切换控制律实现对倾转旋翼机的飞行鲁棒控制;专利[CN201810040012.5一种倾转旋翼飞行器过渡态切换过程的几何最优控制器设计方法]利用SE(3)变换群和哈密顿最小原理建立倾转旋翼飞行器的离散动力学方程,将倾转旋翼飞行器连续空间的控制问题转为设计为一个非线性的几何最优切换控制问题。将连续系统转换用子系统和切换策略来近似,可以简化分析和计算,但是仍然会系统建模误差,同时控制的切换会带来暂态扰动,影响系统的抗干扰性。
发明内容
本发明的目的是针对倾转四旋翼无人机的过渡模式下的被控对象特性变化显著、非线性特性强、系统结构不确定、外部干扰大的情况,通过将神经网络作为在线逼近器近似最优鲁棒性能指标,用动态规划的办法得到最优鲁棒控制输入,满足系统的高抗扰和强鲁棒要求,提出了一种基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法。
为实现上述目的,本发明所提供的技术方案为:
基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,包括以下步骤:
S1、建立倾转四旋翼无人机的动力学模型;
S2、将步骤S1建立的动力学模型整理为仿射非线性形式的模型;
S3、将步骤S2整理得到的仿射非线性形式的模型进行最优鲁棒性设计;
S4、设计在线逼近器近似最优性能指标函数,进而求取最优鲁棒控制器;
S5、通过步骤S4得到的最优鲁棒控制器对倾转四旋翼无人机进行控制。
进一步地,所述步骤S1具体过程如下:
S1-1、首先建立倾转四旋翼无人机的相关坐标系,定义三个坐标系:
惯性坐标系:{I}={xi,yi,zi},为固定在大地的参考坐标系,满足右手定则;
机体坐标系:{B}={xb,yb,zb},表示原点固定在无人机质心上的直角坐标系,Oxb轴指向飞机的机头方向,Oyb轴垂直于飞行器参考面,指向上方为正,Ozb轴垂直Oxbyb平面,指向右方为正,满足右手定则;
风轴坐标系:{W}={xw,yw,zw},表示原点位于飞机的质心,Oxw轴指向飞机的空速方向,Oyw轴位于飞机对称面内,垂直于Oxw轴,指向上方为正,Ozw轴垂直Oxwyw平面,指向右方为正,满足右手定则;
S1-2、对倾转四旋翼无人机进行力学分析,利用牛顿-欧拉方程来描述其模型,得到倾转四旋翼无人机的动力学模型。
进一步地,所述步骤S1-2的具体过程如下:
对于机体坐标系,得到如下动力学方程,其中p、q、r分别为机体坐标下的滚转、偏航和仰俯角速度,Mx,My,Mz分别为折算到机体坐标轴上x、y、z的力矩分量:
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,为气压值,为机翼平均气动弦长,b为机翼翼展长度;
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
进一步地,所述步骤S2的具体过程如下:
设置倾转四旋翼无人机的状态向量,令
x1=[V α β]T,x2=[p q r]T,x3=[φ θ ψ]T,x4=[sinγ 0 cosγ]T,γ为旋翼倾角,x4受x4 Tx4=1的约束;定义四个旋翼升力[T1 T2 T3 T4]为u1,固定翼的操纵包括副翼偏转δa、升降舵偏转δe、方向舵偏转δr,取[δa δe δr]为u2,[cosγ0-sinγ]为u3,γ为旋翼倾角,u3受u3 Tu3=1的约束;
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:
Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
上式中,
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
进一步地,所述步骤S3的具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
上式中,Q,R为正定矩阵;
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
进一步地,所述步骤S4的具体过程如下:
对性能近似函数(10)求取最优输入得到:
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
近似估计的hamilton函数,描述为:
最后得到在线逼近条件下的最优鲁棒输入为:
与现有技术相比,本方案原理及优点如下:
1)结合倾转四旋翼无人机的特点,直接针对无人机非线性模型进行控制器设计,保留了对系统有益的非线性特性,从而有效避免对模型线性化时引入的建模误差。
2)构建最优鲁棒性能指标,利用最优控制方法达到最优鲁棒性能指标,可以实现较强的抗干扰能力和鲁棒性能。
3)以神经网络作为在线逼近器近似最优鲁棒性能指标,用动态规划的办法得到最优鲁棒控制输入,减少了计算量,适合在线运算。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的服务作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明采用倾转式四旋翼无人机以及坐标轴的示意图;
图2为本发明采用倾转式四旋翼无人机在风轴坐标轴的纵向示意图,图(a)为力的分布,图(b)为飞行轨迹角度定义;
图3为本发明基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法原理图;
图4为具体实施例中基于在线逼近器的最优鲁棒控制系统的结构框图;
图5为具体实施例中倾转四旋翼无人机纵向模型在外界风力扰动下的跟踪给定状态的飞行实验数据图,图(a)为角度和位移的响应曲线,图(b)为角速度和位移速度的响应曲线,图(c)为旋翼升力和旋翼倾转速度的响应曲线。
具体实施方式
下面结合具体实施例对本发明作进一步说明:
本实施例采用如图4的系统结构,进行如图3所示的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,具体过程如下:
S1、建立倾转四旋翼无人机的动力学模型:
S1-1、首先建立倾转四旋翼无人机的相关坐标系,定义三个坐标系:
惯性坐标系:{I}={xi,yi,zi},为固定在大地的参考坐标系,满足右手定则;
机体坐标系:{B}={xb,yb,zb},表示原点固定在无人机质心上的直角坐标系,Oxb轴指向飞机的机头方向,Oyb轴垂直于飞行器参考面,指向上方为正,Ozb轴垂直Oxbyb平面,指向右方为正,满足右手定则;
风轴坐标系:{W}={xw,yw,zw},表示原点位于飞机的质心,Oxw轴指向飞机的空速方向,Oyw轴位于飞机对称面内,垂直于Oxw轴,指向上方为正,Ozw轴垂直Oxwyw平面,指向右方为正,满足右手定则;
S1-2、对倾转四旋翼无人机进行力学分析,利用牛顿-欧拉方程来描述其模型,得到倾转四旋翼无人机的动力学模型;
对于机体坐标系,得到如下动力学方程,其中p、q、r分别为机体坐标下的滚转、偏航和仰俯角速度,Mx,My,Mz分别为折算到机体坐标轴上x、y、z的力矩分量:
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,为气压值,为机翼平均气动弦长,b为机翼翼展长度;
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
具体的倾转式四旋翼无人机以及坐标轴如图1所示,而倾转式四旋翼无人机在风轴坐标轴的纵向如图2所示(图(a)为力的分布,图(b)为飞行轨迹角度定义)
S2、将步骤S1建立的动力学模型整理为仿射非线性形式的模型,具体过程如下:
设置倾转四旋翼无人机的状态向量,令
x1=[V α β]T,x2=[p q r]T,x3=[φ θ ψ]T,x4=[sinγ 0 cosγ]T,γ为旋翼倾角,x4受x4 Tx4=1的约束;定义四个旋翼升力[T1 T2 T3 T4]为u1,固定翼的操纵包括副翼偏转δa、升降舵偏转δe、方向舵偏转δr,取[δa δe δr]为u2,[cosγ0-sinγ]为u3,γ为旋翼倾角,u3受u3 Tu3=1的约束;
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:
Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
上式中,
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
S3、将步骤S2整理得到的仿射非线性形式的模型进行最优鲁棒性设计,具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
上式中,Q,R为正定矩阵;
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
S4、设计在线逼近器近似最优性能指标函数,进而求取最优鲁棒控制器,具体如下:
对性能近似函数(10)求取最优输入得到:
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
近似估计的hamilton函数,描述为:
最后得到在线逼近条件下的最优鲁棒输入为:
S5、根据得到的最优滑模控制律,得到姿态控制所需的舵面偏转角指令[δa δeδr],和旋翼倾角指令γ,得到旋翼升力[T1 T2 T3 T4]结合旋翼升力表达式得到旋翼角速度ω。将以上舵面偏转角指令输入到倾转四旋翼无人机进行姿态控制,从而实现高抗扰的过渡飞行过程。
为证明本实施例的有效性,下面在Matlab2017b环境下对倾转四旋翼无人机的过渡飞行模式进行如下仿真验证:
先是无扰动状态下开始从直升机飞行模式切换为固定翼飞行模式,一段时间后,加入风力扰动,并继续进行飞行模式切换。飞行初始状态如下:初始高度为100m,速度2500m/s,从直升机飞行模式切换为固定翼飞行模式,姿态角初始值为[0°,0°,0°],旋翼倾转角度初始为90°,舵面偏转角限制为±30°。切换后姿态角为[0°,90°,0°],切换后旋翼倾转角度为0°;性能指标J中的矩阵Q和R选择为:Q=diag{0.7,0.5,0.6,0.8},R=diag{1,1,1}。
图5为运用基于在线逼近器的最优鲁棒控制的速度响应曲线,总飞行时间为100秒,0-50秒为无风力扰动下的镇定飞行;50-100秒为倾转四旋翼无人机在加入风力扰动的飞行,图(a)为角度和位移的响应曲线,在无风情况下进行状态切换,该控制在25秒左右可以将倾转四旋翼无人机的角度和位移收敛至目标值,误差控制在1°以内;在风力扰动下进行状态切换,该控制在30秒左右可以将倾转四旋翼无人机的角度和位移收敛至目标值,误差控制在1%以内。
图(b)为角速度和位移速度的响应曲线,在无风情况下进行状态切换,该控制在25秒左右可以将倾转四旋翼无人机的角速度和位移速度稳定下来,直到为零;在风力扰动下进行状态切换,该控制在30秒左右可以将倾转四旋翼无人机的角速度和位移速度稳定下来,直到为零。
图(c)为旋翼升力和旋翼倾转速度的响应曲线,在无风情况下进行状态切换,旋翼升力和旋翼倾角在20秒左右进入稳定状态;在50秒后加入风力扰动,旋翼升力和旋翼倾角也在20秒左右进入稳定状态。
以上所述之实施例子只为本发明之较佳实施例,并非以此限制本发明的实施范围,故凡依本发明之形状、原理所作的变化,均应涵盖在本发明的保护范围内。
Claims (3)
1.基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,包括以下步骤:
S1、建立倾转四旋翼无人机的动力学模型;
S2、将步骤S1建立的动力学模型整理为仿射非线性形式的模型;
S3、将步骤S2整理得到的仿射非线性形式的模型进行最优鲁棒性设计;
S4、设计在线逼近器近似最优性能指标函数,进而求取最优鲁棒控制器;
S5、通过步骤S4得到的最优鲁棒控制器对倾转四旋翼无人机进行控制;
所述步骤S2的具体过程如下:
设置倾转四旋翼无人机的状态向量,令x1=[V α β]T,x2=[p q r]T,x3=[φ θ ψ]T,x4=[sinγ 0 cosγ]T,γ为旋翼倾角,x4受x4 Tx4=1的约束;定义四个旋翼升力[T1 T2 T3 T4]为u1,固定翼的操纵包括副翼偏转δa、升降舵偏转δe、方向舵偏转δr,取[δa δe δr]为u2,[cosγ 0 -sinγ]为u3,γ为旋翼倾角,u3受u3 Tu3=1的约束;
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
所述步骤S3的具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
上式中,Q,R为正定矩阵;
设计最优H∞控制器,最小化代价函数∫0 T[z(t)Tz(t)-γ2ω(t)Tw(t)]dt,取最优性能函数为:
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
所述步骤S4的具体过程如下:
对性能近似函数(10)求取最优输入得到:
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
近似估计的hamilton函数,描述为:
最后得到在线逼近条件下的最优鲁棒输入为:
2.根据权利要求1所述的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,所述步骤S1具体过程如下:
S1-1、首先建立倾转四旋翼无人机的相关坐标系,定义三个坐标系:
惯性坐标系:{I}={xi,yi,zi},为固定在大地的参考坐标系,满足右手定则;
机体坐标系:{B}={xb,yb,zb},表示原点固定在无人机质心上的直角坐标系,Oxb轴指向飞机的机头方向,Oyb轴垂直于飞行器参考面,指向上方为正,Ozb轴垂直Oxbyb平面,指向右方为正,满足右手定则;
风轴坐标系:{W}={xw,yw,zw},表示原点位于飞机的质心,Oxw轴指向飞机的空速方向,Oyw轴位于飞机对称面内,垂直于Oxw轴,指向上方为正,Ozw轴垂直Oxwyw平面,指向右方为正,满足右手定则;
S1-2、对倾转四旋翼无人机进行力学分析,利用牛顿-欧拉方程来描述其模型,得到倾转四旋翼无人机的动力学模型。
3.根据权利要求2所述的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,所述步骤S1-2的具体过程如下:
对于机体坐标系,得到如下动力学方程,其中p、q、r分别为机体坐标下的滚转、偏航和仰俯角速度,Mx,My,Mz分别为折算到机体坐标轴上x、y、z的力矩分量:
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,为气压值,为机翼平均气动弦长,b为机翼翼展长度;
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010705753.8A CN111897219B (zh) | 2020-07-21 | 2020-07-21 | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010705753.8A CN111897219B (zh) | 2020-07-21 | 2020-07-21 | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111897219A CN111897219A (zh) | 2020-11-06 |
CN111897219B true CN111897219B (zh) | 2022-11-22 |
Family
ID=73190712
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010705753.8A Expired - Fee Related CN111897219B (zh) | 2020-07-21 | 2020-07-21 | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111897219B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114706416B (zh) * | 2022-01-21 | 2023-08-11 | 中国空气动力研究与发展中心计算空气动力研究所 | 一种倾转四旋翼飞机的过渡飞行控制方法 |
CN114879739B (zh) * | 2022-05-31 | 2024-09-06 | 哈尔滨工业大学 | 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统 |
CN117092961B (zh) * | 2023-10-19 | 2024-01-30 | 南京航空航天大学 | 基于等价输入干扰的旋翼机过渡段的切换控制方法及系统 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425135B (zh) * | 2013-07-30 | 2016-05-04 | 南京航空航天大学 | 一种具有输入饱和的近空间飞行器鲁棒控制方法 |
CN104942809B (zh) * | 2015-06-23 | 2018-04-17 | 广东工业大学 | 基于视觉伺服系统的机械臂动态模糊逼近器 |
CN106054604B (zh) * | 2016-06-02 | 2018-12-25 | 西北工业大学 | 基于模型预测控制理论的再入飞行器鲁棒最优制导方法 |
CN106802570B (zh) * | 2017-04-01 | 2020-02-07 | 广东工业大学 | 一种无人直升机位置跟踪的方法与装置 |
CN107992070A (zh) * | 2017-12-03 | 2018-05-04 | 中国直升机设计研究所 | 一种倾转旋翼飞行器过渡模式自动实现方法 |
CN108445895B (zh) * | 2018-02-05 | 2021-01-29 | 天津大学 | 用于倾转式三旋翼无人机位置控制的鲁棒控制方法 |
JP6860541B2 (ja) * | 2018-10-29 | 2021-04-14 | ファナック株式会社 | 出力装置、制御装置、及び評価関数値の出力方法 |
CN109270960A (zh) * | 2018-12-05 | 2019-01-25 | 中南大学 | 基于Radau伪谱法的在线最优反馈再入制导方法 |
CN109782601B (zh) * | 2019-01-31 | 2021-09-14 | 浙江大学 | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 |
-
2020
- 2020-07-21 CN CN202010705753.8A patent/CN111897219B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN111897219A (zh) | 2020-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111897219B (zh) | 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 | |
CN103488814B (zh) | 一种适用于再入飞行器姿态控制的闭环仿真系统 | |
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN111984020B (zh) | 基于sdre的倾转四旋翼无人机过渡飞行模式自适应最优滑模控制方法 | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN111538255B (zh) | 一种反蜂群无人机的飞行器控制方法及系统 | |
CN113867374B (zh) | 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法 | |
CN115933733A (zh) | 一种固定翼无人机纵向高度速度解耦非线性控制方法 | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
CN114721266A (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
CN114063447B (zh) | 基于动力学分析的双倾转旋翼无人机模式过渡控制方法 | |
CN113093809A (zh) | 一种复合翼无人机的自抗扰控制器及其建立方法 | |
Comer et al. | Full envelope flight control system design and optimization for a tilt-wing aircraft | |
CN116755328B (zh) | 基于切换模糊模型的倾转旋翼无人机过渡段飞行控制方法 | |
Quan et al. | Lifting-wing quadcopter modeling and unified control | |
Orsag et al. | Hybrid fly-by-wire quadrotor controller | |
CN117234228A (zh) | 一种倾转旋翼无人机倾转过程控制方法 | |
McIntosh et al. | A Switching-Free Control Architecture for Transition Maneuvers of a Quadrotor Biplane Tailsitter | |
Daud Filho et al. | A tilt-wing VTOL UAV configuration: Flight dynamics modelling and transition control simulation | |
CN115729264A (zh) | 一种基于柔性自适应翼梢小翼的变稳隐身飞机控制方法 | |
CN214267954U (zh) | 一种可倾转旋翼的复合结构飞行器 | |
Urakubo et al. | Minimum Turning Radius Analysis for Quad-plane UAVs in High-speed Flights | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
Wacker et al. | X-38 application of dynamic inversion flight control | |
CN114167720A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20221122 |
|
CF01 | Termination of patent right due to non-payment of annual fee |