基于动态补偿的小型无人直升机自适应容错控制方法技术

技术编号:27295877 阅读:22 留言:0更新日期:2021-02-06 12:05
本发明专利技术涉及一种小型无人直升机的容错控制方法,主要是基于积分补偿思想设计自适应控制器,属于自适应可靠控制领域。该方法首先建立小型无人直升机系统动力学模型;小型无人直升机非线性模型连续时间线性化;利用多模型方法进行故障系统建模;引入积分补偿的思想,给出基于状态反馈的自适应容错控制策略的具体形式;设计针对未知参数α的自适应估计律,给出求解控制增益的线性矩阵不等式条件,完成算法设计过程。该方法利用参数α把这些子模型组合在一起,构成完整的系统模型,大大简化模型建立复杂度,可降低控制器设计难度;同时将待求解的未知控制参数与未知参数解耦,获得更易求解的线性矩阵不等式条件,确保故障系统的稳定性和鲁棒性。定性和鲁棒性。定性和鲁棒性。

【技术实现步骤摘要】
基于动态补偿的小型无人直升机自适应容错控制方法


[0001]本专利技术涉及一种小型无人直升机的容错控制方法,主要是基于积分补偿思想设计自适应控制器,属于自适应可靠控制领域。

技术介绍

[0002]小型无人直升机具有定点悬停、任意方向飞行、灵活机动、起飞着落场地要求低等特点,在军事和民用方面已有广泛应用。从结构上看,小型无人直升机主要包括主旋翼、伺服小翼、尾桨、机身和垂尾等,任意一个关键部件发生故障都可能影响系统正常运行。此外,由于飞行环境苛刻,小型无人直升机飞行过程未知因素较多,其执行器可能出现失效、偏移等故障并进一步导致飞行失稳。为保证系统的鲁棒性和可靠性,容错控制方法在实际控制过程中被广泛使用。在过去的二十年里,人们研宄了各种容错控制方法,而在实践中,系统发生故障意味着系统模型的改变,因此基于多模型方法的容错控制问题得到了广泛的研宄。在现有的多模容错控制结果中,通常是设计具有固定增益的控制器,称为被动容错控制器。然而被动容错控制方法自我调节能力较弱,即不能随故障的变化而自适应的调整控制策略。
[0003]自适应控制是一种有效的容错控制方法,针对执行器故障补偿问题,文献《Reliable H-infinity control of linear systems with adaptive mechanism》,(叶丹,杨光红,《IEEE Transactiohs on Automatic Control》,2010年第1期第55卷)中提出了一种设计自适应可靠控制器的有效方法。然而控制矩阵中的未知参数与自适应参数的耦合给控制器设计带来了困难,因此有必要研宄新型控制机制。

技术实现思路

[0004]考虑实际飞行过程中存在的机体损伤及部分执行器故障情形,本专利技术设计了一种基于积分补偿的多模型容错控制方法,也即一种基于动态控制器的多模型容错控制方法,该方法能够降低现有方法的设计复杂度,保证小型无人直升机的正常飞行。在此基础上,将基于全状态的控制方法推广到输出反馈控制器设计中,给出鲁棒自适应调整控制策略,充分利用系统冗余能力有效减轻故障带来的影响,以保证飞行器的安全性。
[0005]基于动态控制器的小型无人直升机自适应容错控制通过以下步骤实现:
[0006](a)建立小型无人直升机系统动力学模型:
[0007]设F
b
,τ
b
分别为作用在小型无人直升机上的合外力和合外力矩,e、v、w为小型无人直升机飞行速度在体轴系的三个分量,p、q、r为小型无人直升机角速度在体轴系的三个分量,即
[0008]v
b
=[e v w]T
,ω
b
=[p q r]T

[0009]其中v
b
为小型无人直升机包含体轴三个方向的飞行速度向量,ω
b
为包含体轴三个方向的角速度向量,则小型无人直升机的刚体运动学方程为:
[0010][0011]式中:
[0012][0013]其中,φ,θ,ψ分别表示小型无人直升机个姿态角,m是小型无人直升机质量,g是重力加速度,mr表示主旋翼,tr表示尾桨,fus表示机身,vf表示垂尾,hf表示平尾。F
x
,F
y
,F
z
表示小型无人直升机所受空气动力在体轴系的三分量,表示主旋翼上产生的力投影到机身坐标系的三个坐标轴上的分量,表示尾桨产生的力投影到y方向的分量,X
fus
、Y
fus
、z
fus
表示机身所受空气阻力在体轴系的三分量,Y
vf
表示垂尾在体轴系y方向所受空气阻力,N
vf
表示垂尾产生的偏航力矩,L
vf
表示垂尾产生的滚转力矩,Z
hf
表示平尾在体轴系z方向所受空气阻力,M
hf
表示垂尾产生的俯仰力矩。τ
x
、τ
y
、τ
z
表示小型无人直升机所受力矩在体轴系的三分量,为主旋翼产生的力矩在机身三个轴向上的力矩分量,表示尾桨产生的力矩在y方向的分量,表示主旋翼桨毂到机身质心的垂向距离,表示主旋翼桨毂到机身质心的水平距离,表示尾桨桨毂到机身质心的垂向距离,表示尾桨桨毂到机身质心的水平距离。
[0014]整理后可得到小型无人直升机刚体动力学方程:
[0015][0016]I
xx
、I
yy
、I
zz
表示小型无人直升机机体转动惯量,小型无人直升机姿态角和角速度的关系为如下运动学方程:
[0017][0018]基于以上分析,建立包含9个状态变量和4个控制变量的小型无人直升机飞行动力学非线性数学模型:
[0019][0020]式中列向量x是小型无人直升机的状态变量,包含体轴系三维速度e,v,w,体轴系三维角速度p,q,r,姿态角φ,θ,ψ;向量u是小型无人直升机的飞行控制输入变量,其中δ
col
为主旋翼总距操纵输入,δ
lon
为主旋翼纵向周期位移操纵输入,δ
lat
为主旋翼横向周期位移操纵以及δ
r
为尾桨总距操纵输入,驾驶员可通过这四个控制变量来改变主旋翼拉力T
mr
和尾桨拉力T
ir
的大小和方向,其中
[0021](b)小型无人直升机非线性模型连续时间线性化:
[0022]将模型(1)在平衡点处进行泰勒展开,并只保留线性部分,则有如下关系:
[0023][0024]式中Δx,Δu分别是系统状态变量和控制变量的增量。为书写方便,用x,u分别代替Δx和Δu,则包含9个状态变量的小型无人直升机的线性化运动方程为:
[0025][0026]令
[0027][0028]则可得矩阵形式的小型无人直升机连续时间线性化状态方程:
[0029][0030]其中A0称为系统状态矩阵,其元素由力和力矩对状态变量的偏导数组成,B0称为控制矩阵,其元素由力和力矩对控制变量的偏导数组成。
[0031](c)为了使小型无人直升机系统具有较好的控制性能,考虑外部扰动的影响,构建一类具有外部扰动的连续时间线性模型:
[0032][0033]其中x(t)∈R
n
是状态量,u(t)∈R
m
是控制输入,z(t)∈R
q
是调节输出,ω(t)∈L2[0,∞)是外部干扰。
[0034]考虑小型无人直升机可能存在的系统故障和执行器故障,利用多模型方法进行故障系统建模:
[0035][0036]其中,A
i
和B
i
表示第i种故障模式下系统的状态矩阵和输入矩阵,若系统(3)状态不能完全获得,考虑系统输出为y(t)=Cx(t)+Dω(t),则可构建如下复合系统模型来描述正常系统和可能发生的多种故障模式:...

【技术保护点】

【技术特征摘要】
1.基于动态控制器的小型无人直升机自适应容错控制方法,其特征在于,通过以下步骤实现:(a)建立小型无人直升机系统动力学模型:设F
b
,τ
b
分别为作用在小型无人直升机上的合外力和合外力矩,e、v、w为小型无人直升机飞行速度在体轴系的三个分量,p、q、r为小型无人直升机角速度在体轴系的三个分量,即v
b
=[e v w]
T
,ω
b
=[p q r]
T
,其中v
b
为小型无人直升机包含体轴三个方向的飞行速度向量,ω
b
为包含体轴三个方向的角速度向量,则小型无人直升机的刚体运动学方程为:的角速度向量,则小型无人直升机的刚体运动学方程为:式中:式中:其中,φ,θ,ψ分别表示小型无人直升机个姿态角,m是小型无人直升机质量,g是重力加速度,mr表示主旋翼,tr表示尾桨,fus表示机身,表示垂尾,表示平尾。F
x
,F
y
,F
z
表示小型无人直升机所受空气动力在体轴系的三分量,表示主旋翼上产生的力投影到机身坐标系的三个坐标轴上的分量,表示尾桨产生的力投影到y方向的分量,X
fus
、Y
fus
、Z
fus
表示机身所受空气阻力在体轴系的三分量,表示垂尾在体轴系y方向所受空气阻力,表示垂尾产生的偏航力矩,表示垂尾产生的滚转力矩,表示平尾在体轴系z方向所受空气阻力,表示垂尾产生的俯仰力矩。τ
x
、τ
y
、τ
z
表示小型无人直升机所受力矩在体轴系的三分量,为主旋翼产生的力矩在机身三个轴向上的力矩分量,表示尾桨产生的力矩在y方向的分量,表示主旋翼桨毂到机身质心的垂向距离,表示主旋翼桨毂到机身质心的水平距离,表示尾桨桨毂到机身质心的垂向距离,表示尾桨桨毂到机身质心的水平距离。整理后可得到小型无人直升机刚体动力学方程:整理后可得到小型无人直升机刚体动力学方程:整理后可得到小型无人直升机刚体动力学方程:整理后可得到小型无人直升机刚体动力学方程:整理后可得到小型无人直升机刚体动力学方程:整理后可得到小型无人直升机刚体动力学方程:I
xx
、I
yy
、I
zz
表示小型无人直升机机体转动惯量,小型无人直升机姿态角和角速度的关...

【专利技术属性】
技术研发人员:范泉涌任宏全许斌韩渭辛
申请(专利权)人:西北工业大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1