CN108647442A - 一种基于辅助输出的六旋翼无人机故障估计方法 - Google Patents

一种基于辅助输出的六旋翼无人机故障估计方法 Download PDF

Info

Publication number
CN108647442A
CN108647442A CN201810448305.7A CN201810448305A CN108647442A CN 108647442 A CN108647442 A CN 108647442A CN 201810448305 A CN201810448305 A CN 201810448305A CN 108647442 A CN108647442 A CN 108647442A
Authority
CN
China
Prior art keywords
unmanned aerial
rotor wing
wing unmanned
unmanned plane
matrix
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
CN201810448305.7A
Other languages
English (en)
Other versions
CN108647442B (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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN201810448305.7A priority Critical patent/CN108647442B/zh
Publication of CN108647442A publication Critical patent/CN108647442A/zh
Application granted granted Critical
Publication of CN108647442B publication Critical patent/CN108647442B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G07CHECKING-DEVICES
    • G07CTIME OR ATTENDANCE REGISTERS; REGISTERING OR INDICATING THE WORKING OF MACHINES; GENERATING RANDOM NUMBERS; VOTING OR LOTTERY APPARATUS; ARRANGEMENTS, SYSTEMS OR APPARATUS FOR CHECKING NOT PROVIDED FOR ELSEWHERE
    • G07C5/00Registering or indicating the working of vehicles
    • G07C5/08Registering or indicating performance data other than driving, working, idle, or waiting time, with or without registering driving, working, idle or waiting time
    • G07C5/0808Diagnosing performance data

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Aerodynamic Tests, Hydrodynamic Tests, Wind Tunnels, And Water Tanks (AREA)

Abstract

本发明涉及一种基于辅助输出的六旋翼无人机故障估计方法。首先,根据六旋翼无人机的结构建立动力学空间模型;其次,将六旋翼无人机执行器(电机、旋翼)发生故障后提供的残余升力作为无人机系统的未知输入,建立存在执行器故障的六旋翼无人机系统的状态空间模型;然后,根据六旋翼无人机系统不满足未知输入观测器匹配条件的实际,构建辅助输出突破该条件的限制;接着,对辅助输出系统设计Luenberger观测器;最后,利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,求解出观测器增益,实现对故障电机残余升力信号的精确估计。本发明能够突破观测器匹配条件的限制,适用于六旋翼无人机系统,具有设计简单易工程实现的优点,并且能在外部干扰下对故障后电机提供残余升力信号进行精确估计。

Description

一种基于辅助输出的六旋翼无人机故障估计方法
技术领域
本发明涉及一种基于辅助输出的六旋翼无人机故障估计方法,应用于六旋翼无人机系统执行器故障的故障估计。
背景技术
多旋翼无人机由于具有可远程遥控、垂直起降和飞行姿态稳定等优点,已经在输电线路巡检、森林防火等领域得到广泛应用。相比于广泛研究的四旋翼无人机,六旋翼无人机结构合理,具有更多的执行器,能够提供更多的硬件冗余,使其稳定性大大增强。然而,受无人机自身工艺影响,各个旋翼的电机和螺旋桨由于持续的高速旋转,发生故障的概率会大大增加。发生故障的无人机稳定性会急剧下降,在实际应用过程中容易威胁人员设备安全。研究六旋翼无人机执行器故障估计方法,精确地估计故障信息,是进一步进行无人机容错控制的基础,具有重要意义。
在对于无人机故障的研究中,国内外很多学者采用不同的方法对于无人机的容错控制做了很多工作。但是对于无人机的故障估计工作,没有被广泛研究。
发明内容
本发明的技术解决问题是:针对六旋翼无人机执行器(电机、旋翼)发生故障的问题,提供一种基于辅助输出的六旋翼无人机故障估计方法,符合实际工程中很多机械系统,易于实现,并且同时实现了对对外部干扰的抑制,主要应用于六旋翼无人机故障估计和容错控制。
本发明的技术解决方案为:一种基于辅助输出的六旋翼无人机故障估计方法,其实现步骤如下:
第一步,根据六旋翼无人机的结构建立动力学模型,进而建立六旋翼无人机的状态空间模型;
第二步,将六旋翼无人机执行器(电机、旋翼)发生故障后提供的残余升力作为无人机系统的未知输入,建立存在执行器故障的六旋翼无人机系统的状态空间模型;
第三步,根据六旋翼无人机系统不满足未知输入观测器匹配条件的实际,构建辅助输出突破该条件的限制,并更新所述无人机的执行器发生故障后的状态空间模型;
第四步,对于更新后的满足观测器匹配条件的无人机状态空间模型,设计观测器;
第五步,利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,基于线性矩阵不等式方法,求解出观测器增益,实现对故障电机残余升力信号的精确估计。
所述第一步,建立六旋翼无人机的动力学模型和状态空间模型,实现如下:
小型六旋翼无人机具有飞行高度低,飞行速度相对较慢的特点,因此可以做出如下假设适当地简化无人机的模型:
(1)六旋翼无人机为刚体,建模过程中忽略其微小的弹性形变;
(2)无人机机体材料和质量分布均匀,且外形和结构对称;
(3)忽略无人机飞行时空气阻力的影响。
首先建立无人机机体坐标系和地理坐标系,如图1所示。图中ob为飞行器质心位置,obxb轴位于飞行器左右对称面并指向机头方向,obzb轴位于飞行器左右对称面并垂直obxb轴指向下方,obyb轴垂直于obxbzb平面并指向飞行器右侧。obxbybzb构成六旋翼无人机的机体坐标系,满足右手规则,正方向如图1所示。相对于在地面上活动的人或物来说,地面是静止不动的,故可以将地面上的地理坐标系ogxgygzg视作惯性坐标系,ogxg轴指向正北方向,ogyg轴指向正东方向,ogzg轴垂直指向地面。
然后基于假设(1)(2)(3),将六旋翼无人机模型简化为如图2所示的结构。图中,l1为2、5号电机与机体连接点O之间的距离;l2为1、4号电机与机体连接点M(1、4号电机的力臂)之间的距离;l3为连接点O和M之间的距离。α为1、4号电机力臂与OM延长线的锐夹角。由于无人机结构对称,因此3、6号电机力臂长度也为l2,力臂与ON延长线延长线的锐夹角也为α。
六旋翼无人机的动力学模型为:
式中σ=[φ,θ,ψ]Τ,其中φ,θ,ψ为所述无人机本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;Ω=[p,q,r]Τ,其中p,q,r为三轴欧拉角角速度;J=diag{Jx,Jy,Jz}为所述无人机的转动惯量矩阵,其中,Jx,Jy,Jz为无人机三轴转动惯量;d表示所述无人机在飞行过程中受到的外部扰动及建模不确定部分,Da=[Da1,Da2,Da3]Τ为d的分配矩阵,其中Da1,Da2,Da3为干扰对滚转、俯仰、偏航三个通道的影响因子;W为绕三轴角速度向量与欧拉角向量的转换矩阵;
六旋翼无人机在飞行过程中一般没有大角度的飞行,欧拉角一般是小角度使得sinθ≈tanθ≈0,sinφ≈tanφ≈0,因此W可近似为单位矩阵。则式(1)可以近似表示为:
式中L∈R3×3表示在滚转、俯仰、偏航通道的等效力臂,是由无人机的结构所决定。根据图2,可得具体表达式为:
其中l1为2、5号电机力臂长度,l2为1、4号电机力臂长度,α为1、4号电机力臂与机体夹角,b为升力系数,c为反扭矩系数。
而τc∈R3×3表示机体在滚转、俯仰、偏航通道受到的等效力,其与六旋翼无人机每个电机产生升力的关系为:
τc=Su
定义ωi为第i个旋翼组件(电机)在正常情况下的输出转速,表示第i个电机产生的升力,则(5)式中u=[f1,f2,f3,…,f6]Τ表示各个电机产生的升力。S∈R3×3为各个电机产生的升力对六旋翼无人机姿态角的影响因子,由无人机的结构决定。根据图2,可确定矩阵S为:
综合上文,可得:
其中λ=c/b。
令x1=[φ θ ψ]Τ则可将上式改写为:
式中:
式中,Om×n为m×n维零矩阵,Im×n为m×n维单位矩阵。
则无故障的六旋翼无人机系统状态空间模型为:
式中,g(x,t)为六旋翼无人机系统的非线性部分,满足Lipschitz条件,即:
式中,θ为Lipschitz常数。
综上,建立了六旋翼无人机的动力学模型和状态空间模型。
所述第二步,将六旋翼无人机执行器(电机、旋翼)发生故障后提供的残余升力作为无人机系统的未知输入,建立存在执行器故障的六旋翼无人机系统的状态空间模型,具体实现如下:
六旋翼无人机某一电机发生故障后,其转速将立刻下降至远小于正常的转速。
定义为第i号电机在故障情况下的转速输出。当第i号电机发生故障时,其转速输出可以表示为:
式中,Δωi为第i号电机发生故障后的电机转速输出,为常数。在最严重的故障情况下,Δωi=0,表示电机完全停转。
则发生故障后电机升力fi为:
因此综上可得,某一电机发生故障后六旋翼无人机的动力学模型为:
式中,为发生故障后,电机在六旋翼无人机滚转、俯仰、偏航通道上的作用合力,表达式为:
式中,Δfi表示第i号(1≤i≤6)电机发生故障时产生的残余升力。
在无故障无人机系统基础上建立有故障的无人机状态空间模型:假设第i号电机发生故障,则正常电机提供的升力向量u中第i行元素fi=0;而故障电机提供的残余升力为Δf,残余升力输入矩阵G∈R6×1为第i号电机在输入矩阵B中对应的第i列。因此有故障无人机状态空间模型为:
将六旋翼无人机执行器故障后信号作为无人机系统的未知输入,建立了存在执行器故障的六旋翼无人机系统的状态空间模型。
所述第三步,构建辅助输出突破六旋翼无人机系统不满足观测器匹配条件的限制,并更新所述无人机的执行器发生故障后的状态空间模型,具体实现如下:
观测器是根据系统的外部变量(输入变量和输出变量)的实测值得出状态变量估计值的一类动态系统,在动态系统的故障诊断和容错控制等领域有着重要的应用。
为了实现六旋翼无人机系统故障估计,需要设计观测器,利用测量输出信息,对故障信息进行精确估计。而设计未知输入观测器,需要无人机系统满足如下条件:
1)最小相位条件:系统(A,C,G)的不变零点都具有负实部;等价地,对于所有具有非负实部的负数都有:
2)观测器匹配条件:
rank(CG)=rank(G)
然而在所建立的六旋翼无人机状态空间模型中rank(CG)=0≠rank(G),并不满足rank(CG)=rank(G)的观测器匹配条件,不能直接对所建立的系统设计观测器进行故障估计。因此提出一种辅助输出的方法来突破观测器匹配条件的限制,实现对六旋翼无人机系统的故障估计。
首先,给出算法1来构造y2,C2,F2
算法1
第1步考虑方程
于是
第2步对y1求取一阶微分得:
因为均为0。则:
于是
由于rank(F2)=rank(G),因此新构造的辅助输出方法使得系统满足观测器匹配条件,因此接下来可以对无人机系统设计未知输入观测器进行系统状态和故障的估计。
利用算法1可以得到更新后的无人机状态空间模型:
现实系统中,往往会收到干扰的影响,即上式中的d。而这些干扰往往是未知的,会对无人机故障观测器的准确性产生不利影响。对此,设计鲁棒、滑模、自适应等多种形式的故障检测和故障估计观测器,并将多种方法相互结合,从而抑制未知干扰对观测结果准确性的不利影响。
所述第四步,对于更新后的满足观测器匹配条件的无人机状态空间模型,设计Luenberger观测器:
因而状态和作为未知输入的故障向量估计可以得到,其表达式分别为其中为x的估计值,x为所述无人机三轴欧拉角、欧拉角速度;的估计值,为所述无人机三轴欧拉角、欧拉角速度和故障电机残余升力向量;为故障电机残余升力估计值。
所述第五步,利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,基于线性矩阵不等式方法,求解出观测器增益,实现对故障电机残余升力信号的精确估计,具体实现如下:
假定(A,C,G)为最小相位,对于任意给定的标量γ>0,ε>0,存在正定矩阵P>0,使得下列矩阵不等式成立:
其中
选定增益矩阵L2使得为Hurwitz,那么在零初始条件下对于任意非零的d,满足||e||≤γ||d||,则称:
为系统的渐近收敛观测器,因而系统的状态和作为未知输入的故障向量估计分别为其中为x的估计值,x为所述无人机三轴欧拉角、欧拉角速度;的估计值,为所述无人机三轴欧拉角、欧拉角速度和故障电机残余升力向量;为故障电机残余升力估计值。
本发明与现有技术相比的优点在于:本发明能够突破观测器匹配条件的限制,适用于六旋翼无人机系统和实际中很多机械系统,具有设计简单易工程实现的优点,并且能在外部干扰下对故障后电机提供残余升力信号进行精确估计。
附图说明
图1为本发明一种基于辅助输出的六旋翼无人机故障估计方法的设计流程图;
图2为六旋翼无人机机体坐标系和地理坐标系图;
图3为六旋翼无人机简化结构示意图。
具体实施方式
下面结合附图对本发明进行详细说明。
本发明针对执行器(电机、旋翼)发生故障的六旋翼无人机状态空间模型,设计一种基于辅助输出的故障估计方法;首先,根据六旋翼无人机的结构建立动力学模型,进而建立六旋翼无人机的状态空间模型;其次,将六旋翼无人机执行器(电机、旋翼)发生故障后提供的残余升力作为无人机系统的未知输入,建立存在执行器故障的六旋翼无人机系统的状态空间模型;然后,根据六旋翼无人机系统不满足未知输入观测器匹配条件的实际,构建辅助输出突破该条件的限制,更新所述无人机状态空间模型;接着,对于满足匹配条件的更新后的无人机状态空间模型设计Luenberger观测器;最后,利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,基于线性矩阵不等式方法求解出观测器增益,实现对故障电机残余升力信号的精确估计。
如图1所示,本发明具体实现步骤如下:
1、建立六旋翼无人机的动力学模型和状态空间模型
小型六旋翼无人机具有飞行高度低,飞行速度相对较慢的特点,因此可以做出如下假设适当地简化无人机的模型:
(1)六旋翼无人机为刚体,建模过程中忽略其微小的弹性形变;
(2)无人机机体材料和质量分布均匀,且外形和结构对称;
(3)忽略无人机飞行时空气阻力的影响。
首先建立无人机机体坐标系和地理坐标系,如图2所示,图中ob为飞行器质心位置,obxb轴位于飞行器左右对称面并指向机头方向,obzb轴位于飞行器左右对称面并垂直obxb轴指向下方,obyb轴垂直于obxbzb平面并指向飞行器右侧。obxbybzb构成六旋翼无人机的机体坐标系,满足右手规则,正方向如图2所示。相对于在地面上活动的人或物来说,地面是静止不动的,故可以将地面上的地理坐标系ogxgygzg视作惯性坐标系,ogxg轴指向正北方向,ogyg轴指向正东方向,ogzg轴垂直指向地面。
然后基于假设(1)(2)(3),将六旋翼无人机模型简化为如图3所示的结构,图中,l1为2、5号电机与机体连接点O之间的距离;l2为1、4号电机与机体连接点M(1、4号电机的力臂)之间的距离;l3为连接点O和M之间的距离。α为1、4号电机力臂与OM延长线的锐夹角。由于无人机结构对称,因此3、6号电机力臂长度也为l2,力臂与ON延长线延长线的锐夹角也为α。
六旋翼无人机的动力学模型为:
式中σ=[φ,θ,ψ]Τ,其中φ,θ,ψ为所述无人机本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;Ω=[p,q,r]Τ,其中p,q,r为三轴欧拉角角速度;J=diag{Jx,Jy,Jz}为所述无人机的转动惯量矩阵,其中,Jx,Jy,Jz为无人机三轴转动惯量;d表示所述无人机在飞行过程中受到的外部扰动及建模不确定部分,Da=[Da1,Da2,Da3]Τ为d的分配矩阵,其中Da1,Da2,Da3为干扰对滚转、俯仰、偏航三个通道的影响因子;W为绕三轴角速度向量与欧拉角向量的转换矩阵;
六旋翼无人机在飞行过程中一般没有大角度的飞行,欧拉角一般是小角度使得sinθ≈tanθ≈0,sinφ≈tanφ≈0,因此W近似为单位矩阵。则式(1)可以近似表示为:
式中L∈R3×3表示在滚转、俯仰、偏航通道的等效力臂,是由无人机的结构所决定。根据图3,可得具体表达式为:
其中l1为2、5号电机力臂长度,l2为1、4号电机力臂长度,α为1、4号电机力臂与机体夹角,b为升力系数,c为反扭矩系数。
而τc∈R3×3表示机体在滚转、俯仰、偏航通道受到的等效力,其与六旋翼无人机每个电机产生升力的关系为:
τc=Su
定义ωi为第i个旋翼组件(电机)在正常情况下的输出转速,表示第i个电机产生的升力,则(5)式中u=[f1,f2,f3,…,f6]Τ表示各个电机产生的升力。S∈R3×3为各个电机产生的升力对六旋翼无人机姿态角的影响因子,由无人机的结构决定。根据图2,可确定矩阵S为:
综合上文,可得:
其中λ=c/b。
令x1=[φ θ ψ]Τ则可将上式改写为:
式中:
式中,Om×n为m×n维零矩阵,Im×n为m×n维单位矩阵。
则无故障的六旋翼无人机系统状态空间模型为:
式中g(x,t)为六旋翼无人机系统的非线性部分,满足Lipschitz条件,即:
式中,θ为Lipschitz常数。
2、将六旋翼无人机执行器(电机、旋翼)发生故障后提供的残余升力作为无人机系统的未知输入,建立存在执行器故障的六旋翼无人机系统的状态空间模型:
六旋翼无人机某一电机发生故障后,其转速将立刻下降至远小于正常的转速。
定义为第i号电机在故障情况下的转速输出。当第i号电机发生故障时,其转速输出可以表示为:
式中,Δωi为第i号电机发生故障后的电机转速输出,为常数。在最严重的故障情况下,Δωi=0,表示电机完全停转。
则发生故障后电机升力fi为:
因此综上可得,某一电机发生故障后六旋翼无人机的动力学模型为:
式中,为发生故障后,电机在六旋翼无人机滚转、俯仰、偏航通道上的作用合力,表达式为:
式中,Δfi表示第i号(1≤i≤6)电机发生故障时产生的残余升力。
在无故障无人机系统基础上建立有故障的无人机状态空间模型:假设第i号电机发生故障,则正常电机提供的升力向量u中第i行元素fi=0;而故障电机提供的残余升力为Δf,残余升力输入矩阵G∈R6×1为第i号电机在输入矩阵B中对应的第i列。因此有故障无人机状态空间模型为:
将六旋翼无人机执行器故障后信号作为无人机系统的未知输入,建立了存在执行器故障的六旋翼无人机系统的状态空间模型。
3、构建辅助输出突破六旋翼无人机系统不满足观测器匹配条件的限制,并更新所述无人机的执行器发生故障后的状态空间模型:
为了实现六旋翼无人机系统故障估计,需要设计观测器,利用测量输出信息,对故障信息进行精确估计。而设计未知输入观测器,需要无人机系统满足如下条件:
1)最小相位条件:系统(A,C,G)的不变零点都具有负实部;等价地,对于所有具有非负实部的负数都有:
2)观测器匹配条件:
rank(CG)=rank(G)
然而在所建立的六旋翼无人机状态空间模型中rank(CG)=0≠rank(G),并不满足rank(CG)=rank(G)的观测器匹配条件,不能直接对所建立的系统设计观测器进行故障估计。因此提出一种辅助输出的方法来突破观测器匹配条件的限制,实现对六旋翼无人机系统的故障估计。
首先,给出算法1来构造y2,C2,F2
算法1
第1步考虑方程
于是
第2步对y1求取一阶微分得:
因为均为0。则:
于是
由于rank(F2)=rank(G),因此新构造的辅助输出方法使得系统满足观测器匹配条件,因此接下来可以对无人机系统设计未知输入观测器进行系统状态和故障的估计。
利用算法1可以得到更新的所述无人机状态空间模型:
现实系统中,往往会收到干扰的影响,即上式中的d。而这些干扰往往是未知的,会对无人机故障观测器的准确性产生不利影响。对此,设计鲁棒、滑模、自适应等多种形式的故障检测和故障估计观测器,并将多种方法相互结合,从而抑制未知干扰对观测结果准确性的不利影响。
4、对于更新后的满足观测器匹配条件的无人机状态空间模型,设计Luenberger观测器:
因而状态和作为未知输入的故障向量估计可以得到,其表达式分别为其中为x的估计值,x为所述无人机三轴欧拉角、欧拉角速度;的估计值,为所述无人机三轴欧拉角、欧拉角速度和故障电机残余升力向量;为故障电机残余升力估计值。
5、利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,基于线性矩阵不等式方法,求解出观测器增益,实现对故障电机残余升力信号的精确估计:
假定(A,C,G)为最小相位,对于任意给定的标量γ>0,ε>0,存在正定矩阵P>0,使得下列矩阵不等式成立:
其中
选定增益矩阵L2使得为Hurwitz,那么在零初始条件下对于任意非零的d,满足||e||≤γ||d||,则称:
为系统的渐近收敛观测器,因而系统的状态和作为未知输入的故障向量估计分别为其中为x的估计值,x为所述无人机三轴欧拉角、欧拉角速度;的估计值,为所述无人机三轴欧拉角、欧拉角速度和故障电机残余升力向量;为故障电机残余升力估计值。
总之,本明能够突破很多实际系统中观测器匹配条件不满足的限制,适用于六旋翼无人机等实际的机械系统,结果精确,具有设计简单易工程实现的优点,并且能够对外部干扰进行抑制。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (6)

1.一种基于辅助输出的六旋翼无人机故障估计方法,其特征在于,包括以下步骤:
第一步,根据六旋翼无人机的结构建立所述无人机的动力学模型和状态空间模型;
第二步,将无人机的执行器发生故障后提供的残余升力作为所述无人机的动力学模型的未知输入,建立所述无人机的执行器发生故障后的状态空间模型;
第三步,构建辅助输出,更新所述无人机的执行器发生故障后的状态空间模型,使更新后的所述无人机的执行器发生故障后的状态空间模型满足未知输入观测器的匹配条件;
第四步,对于更新后的无人机状态空间模型,设计观测器;
第五步,利用李亚普诺夫泛函和鲁棒H优化指标相结合的方法,基于线性矩阵不等式,求解所述观测器的增益,精确估计所述无人机的所述执行器发生故障后的所述残余升力,实现所述无人机的故障估计。
2.根据权利要求1所述的六旋翼无人机故障估计方法,其特征在于:所述第一步中,建立无人机的动力学模型如下:
其中,Jx,Jy,Jz分别为所述无人机三轴转动惯量;φ(t),θ(t),ψ(t)分别为无人机本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;分别为三轴姿态角速度;分别为三轴姿态角加速度;Lx,Ly,Lz分别为滚转、俯仰、偏航通道的等效力臂;Sx,Sy,Sz分别为各个电机产生的升力对所述无人机姿态角的影响因子;u(t)=[f1,f2,f3,f4,f5,f6]T为电机产生的升力矩阵,其中f1至f6分别为1至6号电机所产生的升力;Dx,Dy,Dz分别干扰对滚转、俯仰、偏航通道的影响权重;d(t)为所述无人机受到的干扰;
所述第一步中,建立无人机的状态空间模型如下:
式中,x1=[φ θ ψ]Τ 设所述无人机系统三轴欧拉角φ,θ,ψ可测,式中y(t)为所述无人机系统可测量输出,为所述无人机系统输出矩阵;Om×n为m行n列的零矩阵,Ip×q为p行q列的单位矩阵。
3.根据权利要求1所述的六旋翼无人机故障估计方法,其特征在于:所述第二步中,所述无人机存在执行器故障的状态空间模型如下:
式中,为残余升力输入矩阵;uf(t)为所述无人机发生执行器故障后,正常电机产生的升力矩阵;uΔf(t)为发生故障后,故障电机产生的残余升力矩阵。
4.根据权利要求1所述的六旋翼无人机故障估计方法,其特征在于:所述第三步中,构建辅助输出突破观测器匹配条件,更新所述无人机的执行器发生故障后的状态空间模型为:
式中,为构造的辅助输出,表示为:C2、E2、F2、D2分别为:Om×n为m行n列的零矩阵。
5.根据权利要求1所述的六旋翼无人机故障估计方法,其特征在于:所述第四步中,所述观测器如下:
即利用辅助输出使的估计值与其本身值趋近相等,也即真实值与估计值误差趋于0,式中,z为观测器的状态量;的估计值,即所述无人机系统的三轴欧拉角、欧拉角速度和故障电机残余升力的估计值向量;L2、G2和H2为待求的观测器增益矩阵;
6.根据权利要求1所述的六旋翼无人机故障估计方法,其特征在于:所述第五步中,结合李雅普诺夫泛函和鲁棒H优化指标方法条件如下:
通过矩阵运算可将所述结合李雅普诺夫泛函和鲁棒H优化指标方法转换如下条件:
式中,V(e)为Lyapunov泛函,表示为V(e)=eΤPe,P为待设计的正定矩阵,γ>0为性能指标系数,ε,θ为大于0的常数;
用MATLAB中线性矩阵不等式工具箱求解上述矩阵不等式,求得使估计误差的观测器增益矩阵L2、G2和H2,进而求得故障估计其中O1×6为1行6列的零矩阵,I1×6为1行6列的单位矩阵。
CN201810448305.7A 2018-05-11 2018-05-11 一种基于辅助输出的六旋翼无人机故障估计方法 Active CN108647442B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810448305.7A CN108647442B (zh) 2018-05-11 2018-05-11 一种基于辅助输出的六旋翼无人机故障估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810448305.7A CN108647442B (zh) 2018-05-11 2018-05-11 一种基于辅助输出的六旋翼无人机故障估计方法

Publications (2)

Publication Number Publication Date
CN108647442A true CN108647442A (zh) 2018-10-12
CN108647442B CN108647442B (zh) 2020-06-19

Family

ID=63754623

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810448305.7A Active CN108647442B (zh) 2018-05-11 2018-05-11 一种基于辅助输出的六旋翼无人机故障估计方法

Country Status (1)

Country Link
CN (1) CN108647442B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109062242A (zh) * 2018-10-25 2018-12-21 国网四川省电力公司电力科学研究院 一种新的旋翼无人机控制方法
CN110244697A (zh) * 2019-06-26 2019-09-17 哈尔滨工业大学 基于复合观测器的垂直起降飞行器复杂故障诊断辨识方法
CN110271661A (zh) * 2019-06-10 2019-09-24 河南华讯方舟航空科技有限公司 共轴八旋翼飞行器断桨保护方法
CN110531778A (zh) * 2019-07-17 2019-12-03 北京航空航天大学 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法
CN111880410A (zh) * 2020-08-11 2020-11-03 北京航空航天大学 一种针对电机故障的四旋翼无人机容错控制方法
CN112003503A (zh) * 2020-07-23 2020-11-27 西安理工大学 一种基于蚁群龙贝格观测器的永磁同步直线电机控制方法
CN113778115A (zh) * 2021-08-30 2021-12-10 北京三快在线科技有限公司 多旋翼无人机的控制方法、装置、介质、设备及无人机

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103116357A (zh) * 2013-03-14 2013-05-22 郭雷 一种具有抗干扰容错性能的滑模控制方法
US20130219402A1 (en) * 2011-09-06 2013-08-22 Airbus Operations (Sas) Robust system control method with short execution deadlines
CN104458298A (zh) * 2014-12-09 2015-03-25 南京航空航天大学 基于多模型的高速列车悬架系统多执行器故障检测与隔离方法
CN106094514A (zh) * 2016-06-06 2016-11-09 南京邮电大学 基于动态输出反馈控制的柔性航天器主动容错控制方法
CN106873568A (zh) * 2015-12-11 2017-06-20 中国航空工业第六八研究所 基于h无穷鲁棒未知输入观测器的传感器故障诊断方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20130219402A1 (en) * 2011-09-06 2013-08-22 Airbus Operations (Sas) Robust system control method with short execution deadlines
CN103116357A (zh) * 2013-03-14 2013-05-22 郭雷 一种具有抗干扰容错性能的滑模控制方法
CN104458298A (zh) * 2014-12-09 2015-03-25 南京航空航天大学 基于多模型的高速列车悬架系统多执行器故障检测与隔离方法
CN106873568A (zh) * 2015-12-11 2017-06-20 中国航空工业第六八研究所 基于h无穷鲁棒未知输入观测器的传感器故障诊断方法
CN106094514A (zh) * 2016-06-06 2016-11-09 南京邮电大学 基于动态输出反馈控制的柔性航天器主动容错控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张建成,朱芳来: "匹配条件不满足时线性系统未知输入观测器设计", 《控制理论与应用》 *
殷芝霞: "四旋翼直升机多故障系统故障诊断与容错技术研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109062242A (zh) * 2018-10-25 2018-12-21 国网四川省电力公司电力科学研究院 一种新的旋翼无人机控制方法
CN109062242B (zh) * 2018-10-25 2021-03-16 国网四川省电力公司电力科学研究院 一种新的旋翼无人机控制方法
CN110271661A (zh) * 2019-06-10 2019-09-24 河南华讯方舟航空科技有限公司 共轴八旋翼飞行器断桨保护方法
CN110244697A (zh) * 2019-06-26 2019-09-17 哈尔滨工业大学 基于复合观测器的垂直起降飞行器复杂故障诊断辨识方法
CN110531778A (zh) * 2019-07-17 2019-12-03 北京航空航天大学 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法
CN112003503A (zh) * 2020-07-23 2020-11-27 西安理工大学 一种基于蚁群龙贝格观测器的永磁同步直线电机控制方法
CN111880410A (zh) * 2020-08-11 2020-11-03 北京航空航天大学 一种针对电机故障的四旋翼无人机容错控制方法
CN111880410B (zh) * 2020-08-11 2021-12-28 北京航空航天大学 一种针对电机故障的四旋翼无人机容错控制方法
CN113778115A (zh) * 2021-08-30 2021-12-10 北京三快在线科技有限公司 多旋翼无人机的控制方法、装置、介质、设备及无人机

Also Published As

Publication number Publication date
CN108647442B (zh) 2020-06-19

Similar Documents

Publication Publication Date Title
CN108647442A (zh) 一种基于辅助输出的六旋翼无人机故障估计方法
CN106643737B (zh) 风力干扰环境下四旋翼飞行器姿态解算方法
CN108388270B (zh) 面向安全域的集群无人机轨迹姿态协同控制方法
CN107479567B (zh) 动态特性未知的四旋翼无人机姿态控制器及方法
CN106527137B (zh) 基于观测器的四旋翼无人机容错控制方法
CN107608367B (zh) 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法
CN111880410B (zh) 一种针对电机故障的四旋翼无人机容错控制方法
CN108445760A (zh) 基于自适应故障估计观测器的四旋翼无人机容错控制方法
CN111538346B (zh) 一种四旋翼直升飞机的干扰观测补偿飞行控制方法
Lu et al. Real-time simulation system for UAV based on Matlab/Simulink
CN109947126A (zh) 四旋翼无人机的控制方法、装置、设备及可读介质
Tomić et al. Simultaneous estimation of aerodynamic and contact forces in flying robots: Applications to metric wind estimation and collision detection
CN103853157A (zh) 一种基于自适应滑模的飞行器姿态控制方法
CN108132604A (zh) 基于四元数的四旋翼飞行器鲁棒姿态控制方法、装置及系统
CN109635494A (zh) 一种飞行试验与地面仿真气动力数据综合建模方法
Xiang et al. Wind field estimation through autonomous quadcopter avionics
CN107101636B (zh) 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法
Stepanyan et al. Estimation, navigation and control of multi-rotor drones in an urban wind field
CN109507890A (zh) 一种基于eso的无人机动态逆广义预测控制器
Freddi et al. Actuator fault detection and isolation system for an hexacopter
CN113342037A (zh) 具有输入饱和的多旋翼无人机时变编队控制方法及系统
Wang et al. An actuator fault detection and reconstruction scheme for hex-rotor unmanned aerial vehicle
Wang et al. Hybrid modeling based double-granularity fault detection and diagnosis for quadrotor helicopter
Yu et al. Robust backstepping tracking control of uncertain MIMO nonlinear systems with application to quadrotor UAVs
Chen et al. Invariant-EKF design for quadcopter wind estimation

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