CN111897219A - 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 - Google Patents

基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 Download PDF

Info

Publication number
CN111897219A
CN111897219A CN202010705753.8A CN202010705753A CN111897219A CN 111897219 A CN111897219 A CN 111897219A CN 202010705753 A CN202010705753 A CN 202010705753A CN 111897219 A CN111897219 A CN 111897219A
Authority
CN
China
Prior art keywords
rotor
aerial vehicle
unmanned aerial
optimal
online
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.)
Granted
Application number
CN202010705753.8A
Other languages
English (en)
Other versions
CN111897219B (zh
Inventor
徐胜
苏成悦
陈元电
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong University of Technology
Original Assignee
Guangdong University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangdong University of Technology filed Critical Guangdong University of Technology
Priority to CN202010705753.8A priority Critical patent/CN111897219B/zh
Publication of CN111897219A publication Critical patent/CN111897219A/zh
Application granted granted Critical
Publication of CN111897219B publication Critical patent/CN111897219B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive 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/027Adaptive 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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的力矩分量:
Figure BDA0002594689560000031
Figure BDA0002594689560000032
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
Figure BDA0002594689560000041
Figure BDA0002594689560000042
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,
Figure BDA0002594689560000043
为气压值,
Figure BDA0002594689560000044
为机翼平均气动弦长,b为机翼翼展长度;
对于惯性坐标系,得到如下运动学方程,其中
Figure BDA0002594689560000045
θ、ψ为惯性坐标系下无人机的滚转、偏航和仰俯角:
Figure BDA0002594689560000046
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
Figure BDA0002594689560000047
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
Figure BDA0002594689560000048
进一步地,所述步骤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的约束;
于是公式(1)表达为:
Figure BDA0002594689560000051
上式中,
Figure BDA0002594689560000052
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:
Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
公式(2)表达为:
Figure BDA0002594689560000053
上式中,
Figure BDA0002594689560000054
公式(3)表达为:
Figure BDA0002594689560000055
上式中,
Figure BDA0002594689560000056
Figure BDA0002594689560000057
Figure BDA0002594689560000058
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
Figure BDA0002594689560000061
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
Figure BDA0002594689560000062
进一步地,所述步骤S3的具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
Figure BDA0002594689560000063
上式中,Q,R为正定矩阵;
设计最优H控制器,最小化代价函数
Figure BDA0002594689560000064
取最优性能函数为:
Figure BDA0002594689560000065
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
Figure BDA0002594689560000066
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
Figure BDA0002594689560000067
可得最优输入为:
Figure BDA0002594689560000068
上式中,
Figure BDA0002594689560000069
J*为最优性能指标。
进一步地,所述步骤S4的具体过程如下:
将性能函数(8)表示为近似函数:
Figure BDA0002594689560000071
其中,
Figure BDA0002594689560000072
为近似系数,
Figure BDA0002594689560000073
为线性独立的基函数,εd(x)为近似误差,其上界为||εd(x)||≤εdM;性能函数的梯度为
Figure BDA0002594689560000074
对性能近似函数(10)求取最优输入得到:
Figure BDA0002594689560000075
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
Figure BDA0002594689560000076
近似估计的hamilton函数,描述为:
Figure BDA0002594689560000077
系数估计
Figure BDA0002594689560000078
的在线更新率为:
Figure BDA0002594689560000079
上式中α1,α2为正定的常值系数,
Figure BDA00025946895600000710
Figure BDA00025946895600000711
Jx=Px,P为正定矩阵;
Figure BDA00025946895600000712
是切换函数,表示如下:
Figure BDA00025946895600000713
最后得到在线逼近条件下的最优鲁棒输入为:
Figure BDA00025946895600000714
与现有技术相比,本方案原理及优点如下:
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的力矩分量:
Figure BDA0002594689560000091
Figure BDA0002594689560000092
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
Figure BDA0002594689560000093
Figure BDA0002594689560000094
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,
Figure BDA0002594689560000095
为气压值,
Figure BDA0002594689560000096
为机翼平均气动弦长,b为机翼翼展长度;
对于惯性坐标系,得到如下运动学方程,其中
Figure BDA0002594689560000101
θ、ψ为惯性坐标系下无人机的滚转、偏航和仰俯角:
Figure BDA0002594689560000102
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
Figure BDA0002594689560000103
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
Figure BDA0002594689560000104
具体的倾转式四旋翼无人机以及坐标轴如图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的约束;
于是公式(1)表达为:
Figure BDA0002594689560000105
上式中,
Figure BDA0002594689560000111
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:
Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
公式(2)表达为:
Figure BDA0002594689560000112
上式中,
Figure BDA0002594689560000113
公式(3)表达为:
Figure BDA0002594689560000114
上式中,
Figure BDA0002594689560000115
Figure BDA0002594689560000116
Figure BDA0002594689560000117
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
Figure BDA0002594689560000118
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
Figure BDA0002594689560000119
S3、将步骤S2整理得到的仿射非线性形式的模型进行最优鲁棒性设计,具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
Figure BDA0002594689560000121
上式中,Q,R为正定矩阵;
设计最优H控制器,最小化代价函数
Figure BDA0002594689560000122
取最优性能函数为:
Figure BDA0002594689560000123
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
Figure BDA0002594689560000124
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
Figure BDA00025946895600001211
可得最优输入为:
Figure BDA0002594689560000125
上式中,
Figure BDA0002594689560000126
J*为最优性能指标。
S4、设计在线逼近器近似最优性能指标函数,进而求取最优鲁棒控制器,具体如下:
将性能函数(8)表示为近似函数:
Figure BDA0002594689560000127
其中,
Figure BDA0002594689560000128
为近似系数,
Figure BDA0002594689560000129
为线性独立的基函数,εd(x)为近似误差,其上界为||εd(x)||≤εdM;性能函数的梯度为
Figure BDA00025946895600001210
对性能近似函数(10)求取最优输入得到:
Figure BDA0002594689560000131
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
Figure BDA0002594689560000132
近似估计的hamilton函数,描述为:
Figure BDA0002594689560000133
系数估计
Figure BDA0002594689560000134
的在线更新率为:
Figure BDA0002594689560000135
上式中α1,α2为正定的常值系数,
Figure BDA0002594689560000136
Figure BDA0002594689560000137
Jx=Px,P为正定矩阵;
Figure BDA0002594689560000138
是切换函数,表示如下:
Figure BDA0002594689560000139
最后得到在线逼近条件下的最优鲁棒输入为:
Figure BDA00025946895600001310
S5、根据得到的最优滑模控制律,得到姿态控制所需的舵面偏转角指令[δa δeδr],和旋翼倾角指令γ,得到旋翼升力[T1 T2 T3 T4]结合旋翼升力表达式
Figure BDA00025946895600001311
得到旋翼角速度ω。将以上舵面偏转角指令输入到倾转四旋翼无人机进行姿态控制,从而实现高抗扰的过渡飞行过程。
为证明本实施例的有效性,下面在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 (6)

1.基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,包括以下步骤:
S1、建立倾转四旋翼无人机的动力学模型;
S2、将步骤S1建立的动力学模型整理为仿射非线性形式的模型;
S3、将步骤S2整理得到的仿射非线性形式的模型进行最优鲁棒性设计;
S4、设计在线逼近器近似最优性能指标函数,进而求取最优鲁棒控制器;
S5、通过步骤S4得到的最优鲁棒控制器对倾转四旋翼无人机进行控制。
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的力矩分量:
Figure FDA0002594689550000021
Figure FDA0002594689550000022
上式中,Jx、Jy、Jz、Jxy、Jxz、Jyz分别为机体坐标系下关于x、y、z的转动惯量和惯量积;力矩M=[Mx My Mz]=Mrotor+Mthrust+Maero,Mrotor表示旋翼在旋转过程中施加在每个转子的轮毂上得阻力产生的力矩,Mthrust表示旋翼升力产生的力矩,Maero表示风在副翼、升降舵、方向舵产生的力矩;
Figure FDA0002594689550000023
Figure FDA0002594689550000024
上式中T1、T2、T3、T4为四个旋翼的升力,γ为旋翼倾角,l1为旋翼到重心的距离,kp为旋翼力矩系数,kp为旋翼力矩系数;Cn、Cm、Cl分别是仰俯、滚转、偏航的力矩动力学系数,S是机翼面积,
Figure FDA0002594689550000025
为气压值,
Figure FDA0002594689550000026
为机翼平均气动弦长,b为机翼翼展长度;
对于惯性坐标系,得到如下运动学方程,其中
Figure FDA0002594689550000029
θ、ψ为惯性坐标系下无人机的滚转、偏航和仰俯角:
Figure FDA0002594689550000027
对于风轴坐标系,得到如下动力学方程,其中V、α、β是风速、攻角、侧滑角
Figure FDA0002594689550000028
上式中,m为无人机质量,Fx、Fy、Fz为机体坐标系上的各轴受力;D、Y、L为风轴坐标系各轴方向上无人机在风速下产生的气动力,
其中,F=[Fx Fy Fz]T=Fg+Frotor,Fg为重力在机体坐标各轴上的分量,Frotor为旋翼产生的升力在机体坐标各轴上的分量;
Figure FDA0002594689550000031
4.根据权利要求3所述的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,所述步骤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的约束;
于是公式(1)表达为:
Figure FDA0002594689550000032
上式中,
Figure FDA0002594689550000033
M=Mrotor+Mthrust+Maero=[Mx My Mz],可表达为:
Mrotor=x4 TKRu1,Mthrust=x4 TKTu1,Maero=Kau2,其中,KR为旋翼阻力力矩系数矩阵,KT为旋翼升力力矩系数矩阵,Ka空气动力产生的力矩系数矩阵;
公式(2)表达为:
Figure FDA0002594689550000034
上式中,
Figure FDA0002594689550000035
公式(3)表达为:
Figure FDA0002594689550000036
上式中,
Figure FDA0002594689550000041
Figure FDA0002594689550000042
Figure FDA0002594689550000043
上式中,S、Sfuse、SHT、SVT分别为机翼、机身、升降舵、方向舵的面积,ρ为空气密度,CL、CLf、CDf、CY、CD为分别为机翼升力、机身升力、机身拉力、方向舵侧推力、升降舵拉力的气动系数;
最后基于公式(4)(5)(6)整理得到仿射非线性形式的模型:
Figure FDA0002594689550000044
其中,x=[x1 x2 x3 x4]T,u=[u1 u2 u3]T,w为扰动;
Figure FDA0002594689550000045
5.根据权利要求4所述的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,所述步骤S3的具体过程如下:
对于式(7)的仿射非线性形式的模型,设计输出罚函数为:
Figure FDA0002594689550000046
上式中,Q,R为正定矩阵;
设计最优H控制器,最小化代价函数
Figure FDA0002594689550000047
取最优性能函数为:
Figure FDA0002594689550000048
t=0时,旋翼倾角γ=0°,此时无人机为垂直起降状态;t=tf时,旋翼倾角γ=90°,此时无人机为固定翼巡航状态,ψ(x(tf),tf)表达了对终端状态的约束;
取相应的hamilton函数为:
Figure FDA0002594689550000051
上式中,(uTKuu-1)2为输入约束u3 Tu3=1的约束惩罚项;
Figure FDA0002594689550000059
可得最优输入为:
Figure FDA0002594689550000052
上式中,
Figure FDA0002594689550000053
J*为最优性能指标。
6.根据权利要求5所述的基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法,其特征在于,所述步骤S4的具体过程如下:
将性能函数(8)表示为近似函数:J=ΦTθ(x)+εd(x) (10)
其中,
Figure FDA00025946895500000510
为近似系数,θ(x):
Figure FDA00025946895500000511
为线性独立的基函数,εd(x)为近似误差,其上界为||εd(x)||≤εdM;性能函数的梯度为
Figure FDA00025946895500000512
对性能近似函数(10)求取最优输入得到:
Figure FDA0002594689550000054
设计在线逼近器对(10)的性能指标进行在线估计,得到以下在线逼近估计式:
Figure FDA0002594689550000055
近似估计的hamilton函数,描述为:
Figure FDA0002594689550000056
系数估计
Figure FDA00025946895500000513
的在线更新率为:
Figure FDA0002594689550000057
上式中α1,α2为正定的常值系数,
Figure FDA0002594689550000058
Figure FDA0002594689550000061
Jx=Px,P为正定矩阵;
Figure FDA0002594689550000064
是切换函数,表示如下:
Figure FDA0002594689550000062
最后得到在线逼近条件下的最优鲁棒输入为:
Figure FDA0002594689550000063
CN202010705753.8A 2020-07-21 2020-07-21 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法 Expired - Fee Related CN111897219B (zh)

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 true CN111897219A (zh) 2020-11-06
CN111897219B 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)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114706416A (zh) * 2022-01-21 2022-07-05 中国空气动力研究与发展中心计算空气动力研究所 一种倾转四旋翼飞机的过渡飞行控制方法
CN117092961A (zh) * 2023-10-19 2023-11-21 南京航空航天大学 基于等价输入干扰的旋翼机过渡段的切换控制方法及***

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425135A (zh) * 2013-07-30 2013-12-04 南京航空航天大学 一种具有输入饱和的近空间飞行器鲁棒控制方法
CN104942809A (zh) * 2015-06-23 2015-09-30 广东工业大学 基于视觉伺服***的机械臂动态模糊逼近器
CN106054604A (zh) * 2016-06-02 2016-10-26 西北工业大学 基于模型预测控制理论的再入飞行器鲁棒最优制导方法
CN106802570A (zh) * 2017-04-01 2017-06-06 广东工业大学 一种无人直升机位置跟踪的方法与装置
CN107992070A (zh) * 2017-12-03 2018-05-04 中国直升机设计研究所 一种倾转旋翼飞行器过渡模式自动实现方法
CN108445895A (zh) * 2018-02-05 2018-08-24 天津大学 用于倾转式三旋翼无人机位置控制的鲁棒控制方法
CN109270960A (zh) * 2018-12-05 2019-01-25 中南大学 基于Radau伪谱法的在线最优反馈再入制导方法
CN109782601A (zh) * 2019-01-31 2019-05-21 浙江大学 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法
US20200133208A1 (en) * 2018-10-29 2020-04-30 Fanuc Corporation Output device, control device and method of outputting evaluation function value

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425135A (zh) * 2013-07-30 2013-12-04 南京航空航天大学 一种具有输入饱和的近空间飞行器鲁棒控制方法
CN104942809A (zh) * 2015-06-23 2015-09-30 广东工业大学 基于视觉伺服***的机械臂动态模糊逼近器
CN106054604A (zh) * 2016-06-02 2016-10-26 西北工业大学 基于模型预测控制理论的再入飞行器鲁棒最优制导方法
CN106802570A (zh) * 2017-04-01 2017-06-06 广东工业大学 一种无人直升机位置跟踪的方法与装置
CN107992070A (zh) * 2017-12-03 2018-05-04 中国直升机设计研究所 一种倾转旋翼飞行器过渡模式自动实现方法
CN108445895A (zh) * 2018-02-05 2018-08-24 天津大学 用于倾转式三旋翼无人机位置控制的鲁棒控制方法
US20200133208A1 (en) * 2018-10-29 2020-04-30 Fanuc Corporation Output device, control device and method of outputting evaluation function value
CN109270960A (zh) * 2018-12-05 2019-01-25 中南大学 基于Radau伪谱法的在线最优反馈再入制导方法
CN109782601A (zh) * 2019-01-31 2019-05-21 浙江大学 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
姜洋: "四旋翼垂直起降机的鲁棒控制问题研究", 《万方学位论文》 *
张帆: "空间飞网机器人释放动力学与控制方法研究", 《万方学位论文》 *
李荣: "《无人直升机的非线性鲁棒自适应抗扰控制》", 《万方学位论文》 *
殷苌茗: "激励学习的若干新算法及其理论研究", 《万方学位论文》 *
章鹏: "基于连续动作空间的行动者评论家方法研究", 《万方学位论文》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114706416A (zh) * 2022-01-21 2022-07-05 中国空气动力研究与发展中心计算空气动力研究所 一种倾转四旋翼飞机的过渡飞行控制方法
CN114706416B (zh) * 2022-01-21 2023-08-11 中国空气动力研究与发展中心计算空气动力研究所 一种倾转四旋翼飞机的过渡飞行控制方法
CN117092961A (zh) * 2023-10-19 2023-11-21 南京航空航天大学 基于等价输入干扰的旋翼机过渡段的切换控制方法及***
CN117092961B (zh) * 2023-10-19 2024-01-30 南京航空航天大学 基于等价输入干扰的旋翼机过渡段的切换控制方法及***

Also Published As

Publication number Publication date
CN111897219B (zh) 2022-11-22

Similar Documents

Publication Publication Date Title
CN103488814B (zh) 一种适用于再入飞行器姿态控制的闭环仿真***
CN109062042B (zh) 一种旋翼飞行器的有限时间航迹跟踪控制方法
CN108445895B (zh) 用于倾转式三旋翼无人机位置控制的鲁棒控制方法
CN111984020B (zh) 基于sdre的倾转四旋翼无人机过渡飞行模式自适应最优滑模控制方法
CN111538255B (zh) 一种反蜂群无人机的飞行器控制方法及***
CN110316400B (zh) 一种鸭翼布局固定翼无人机直接升力控制方法
Oosedo et al. Design and simulation of a quad rotor tail-sitter unmanned aerial vehicle
CN111897219B (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) 飞机舵面结构性缺失故障情况下的自适应重构控制方法
CN113093809A (zh) 一种复合翼无人机的自抗扰控制器及其建立方法
CN113867374A (zh) 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法
CN116755328B (zh) 基于切换模糊模型的倾转旋翼无人机过渡段飞行控制方法
Cerezo-Pacheco et al. Integration of X-Plane and Matlab for modeling and simulation of a tiltrotor UAV
McIntosh et al. A Switching-Free Control Architecture for Transition Maneuvers of a Quadrotor Biplane Tailsitter
CN117234228A (zh) 一种倾转旋翼无人机倾转过程控制方法
Quan et al. Lifting-wing quadcopter modeling and unified control
CN115729264A (zh) 一种基于柔性自适应翼梢小翼的变稳隐身飞机控制方法
CN214267954U (zh) 一种可倾转旋翼的复合结构飞行器
CN114167720A (zh) 基于观测器的倾转式三旋翼无人机轨迹跟踪控制方法
Cheviron et al. Generic nonlinear model of reduced scale uavs
Battipede et al. Control allocation system for an innovative remotely-piloted airship
Wacker et al. X-38 application of dynamic inversion flight control
Kulikov Synthesis of automatic control for plane-type UAV landing and stability analysis of desired motion regimes

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