CN111722614A - 一种基于广义观测器的四旋翼无人机故障估计方法 - Google Patents
一种基于广义观测器的四旋翼无人机故障估计方法 Download PDFInfo
- Publication number
- CN111722614A CN111722614A CN202010541600.4A CN202010541600A CN111722614A CN 111722614 A CN111722614 A CN 111722614A CN 202010541600 A CN202010541600 A CN 202010541600A CN 111722614 A CN111722614 A CN 111722614A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- matrix
- attitude
- rotor unmanned
- 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
Links
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
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0259—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the response to fault detection
- G05B23/0262—Confirmation of fault detection, e.g. extra checks to confirm that a failure has indeed occurred
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/24—Pc safety
- G05B2219/24065—Real time diagnostics
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于广义观测器的四旋翼无人机故障估计方法,包括如下步骤:针对四旋翼无人机动力学系统模型,考虑其传感器故障,建立四旋翼无人机姿态传感器故障模型;将四旋翼姿态和传感器故障增广,得到新的增广系统;针对所得新的增广系统,设计广义观测器,用于实现对四旋翼无人机姿态和传感器故障的同时估计;基于广义观测器以及增广无人机姿态故障模型,得到姿态误差模型;将姿态误差模型的误差系统视为正系统,利用正系统理论求得观测器增益矩阵,实现对四旋翼无人机姿态和传感器故障的同时估计。本发明通过正系统理论的应用,大大简化了系统的性能分析,相比传统的H∞方法,大大降低了观测器增益矩阵的求解复杂度。
Description
技术领域
本发明属于飞行控制领域,具体涉及一种基于广义观测器的四旋翼无人机故障估计方法。
背景技术
随着航空科技的高速发展,无人机消费蓬勃发展,市场前景巨大,从而引起了大量国内外学者对无人机技术的研究兴趣。由于良好的机动性能以及较强的环境适应能力,无人机在军事和民用领域中都获得了广泛的应用。根据无人机的机翼类型和产生的动力方式可以将无人机分为固定翼无人机和旋翼无人机两类。其中,旋翼无人机因能实现垂直起降、悬停、盘旋等任务而受到越来越广泛的关注。目前市面上采用的无人机一般为四旋翼无人机,相较于其他无人机,四旋翼无人机由于其体积小、携带方便、提供的动力大、机械结构简单、维护方便、飞行空间要求不高等优点已经受到越来越广泛的关注以及应用。在民用方面,主要用于抢险救灾、航拍、数传、快递、农业方面的施肥喷农药等方面,在军事方面主要用于反恐、监测、巡逻、地面通信等方面。四旋翼无人机研究热点包括:定高、定点、自主导航、姿态的解算、姿态控制等。其中,姿态控制部分是四旋翼飞行器研究其它方面的基础,作为稳定飞行的核心部分,也是国内外研究的热点问题。
然而,在四旋翼无人机飞行过程中,受外界环境因素以及自身工艺的影响,难免会发生一些不可预测的情况,从而大大增加发生故障的概率,威胁人员设备安全。根据故障发生的位置,可将故障分为传感器故障、执行器故障、元器件故障。其中,传感器故障为在无人机系统中传感器不能准确测量到系统的实际数据,即传感器测出的数据偏离实际值,甚至与实际值完全不相关。根据故障发生的个数,可以将其分为单故障和多故障。其中,单故障为无人机系统中单个器件发生故障,如单个执行器故障、单个传感器故障等。作为测量无人机姿态信息的核心,传感器承担了为无人机飞行提供安全可靠数据的重要任务,传感器是否发生故障对飞行安全与否起到了至关重要的作用。
随着故障诊断技术的不断进步,大量有效的故障诊断方法应运而生。如,定量数学模型方法、定性模型方法、等价空间法、观测器方法。其中,数观测器方法最为常见。对于存在扰动的线性系统,设计观测器的关键在于鲁棒性问题处理,主要策略是使得建立的误差系统避免外部干扰的影响。针对一般的扰动线性系统,传统的H∞方法被广泛应用,目标观测器增益矩阵基于线性矩阵不等式的求解,但是这种方法由于观测器增益矩阵的求解复杂度较高,系统的性能分析也较复杂,导致故障信息的估计不够精确。
如何更加精确地估计故障信息,是进一步进行无人机容错控制的基础,因此,研究四旋翼无人机姿态传感器故障估计方法具有重要的价值和现实意义。
发明内容
发明目的:为了克服现有技术中存在的不足,提供一种基于广义观测器的四旋翼无人机故障估计方法,为进一步进行无人机容错控制奠定了的基础。
技术方案:为实现上述目的,本发明提供一种基于广义观测器的四旋翼无人机故障估计方法,包括如下步骤:
S1:针对四旋翼无人机动力学系统模型,考虑其传感器故障,建立四旋翼无人机姿态传感器故障模型;
S2:基于四旋翼无人机姿态传感器故障模型,将四旋翼姿态和传感器故障增广,得到新的增广系统;
S3:针对所得新的增广系统,设计广义观测器,用于实现对四旋翼无人机姿态和传感器故障的同时估计;
S4:基于广义观测器以及增广无人机姿态故障模型,得到姿态误差模型;
S5:将姿态误差模型的误差系统视为正系统,利用正系统理论求得观测器增益矩阵,实现对四旋翼无人机姿态和传感器故障的同时估计。
进一步的,所述步骤S1中四旋翼无人机动力学系统模型为:
其中,J1,J2,J3为转动惯量;l为无人机质心与旋翼电机之间的距离;c为扭矩系数;ki(i=1,2,...,6)为空气阻力系数;wi(i=1,2,...,6)为外输入扰动;ui(i=1,2,...,4)为控制输入;m为无人机质量;g为重力加速度;x,y,z为三轴坐标;为无人机在相应坐标轴方向的速度;为无人机在相应坐标轴方向的加速度;φ,θ,为无人机姿态角,分别为滚转角,俯仰角,偏航角;为相应三个姿态角速度; 为相应三个姿态角加速度。
进一步的,所述步骤S1中四旋翼无人机姿态传感器故障模型的建立过程为:
其中,x(t)为系统状态量,为状态变量x(t)的导数,u(t)为控制量,d(t)为外部输入干扰,y(t)为系统输出,f(t)为传感器故障,矩阵A为系统矩阵,矩阵B为输入矩阵,矩阵C为输出矩阵,矩阵D为外部扰动矩阵。
进一步的,所述步骤S2中增广系统为:
进一步的,所述步骤S3中广义观测器为:
进一步的,所述步骤S4中姿态误差模型为:
进一步的,所述步骤S5中利用L1性能指标刻画鲁棒性。
进一步的,L1性能指标刻画鲁棒性具体为:
其中,sup表示上确界,||·||1表示向量的一范数,w(t)∈L1[0,∞)表示w(t)属于L1[0,∞)空间,∞表示无穷大,L1性能指标γ为给定正数。γ越小,抗干扰性能越强,外输入干扰对四旋翼姿态及传感器故障估计的影响就越小。
有益效果:本发明与现有技术相比,具备如下优点:
1、本发明考虑外输入干扰对系统的影响,建立四旋翼无人机姿态故障模型,利用增广方法,基于广义观测器的设计,实现了对无人机姿态和传感器故障的同时估计,对干扰亦有良好的抑制效果。
2、本发明应用正系统理论,通过L1性能指标刻画鲁棒性,基于线性规划求解得目标观测器增益矩阵,大大简化了系统的性能分析,相比传统的H∞方法,大大降低了观测器增益矩阵的求解复杂度,提高了故障估计的精确度。
附图说明
图1为本发明方法的流程示意图;
图2为本发明故障估计原理图。
具体实施方式
下面结合附图和具体实施例,进一步阐明本发明,应理解这些实施例仅用于说明本发明而不用于限制本发明的范围,在阅读了本发明之后,本领域技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。
如图1和图2所示,本发明提供一种基于广义观测器的四旋翼无人机故障估计方法,主要包括以下步骤:
步骤1:针对四旋翼无人机动力学系统模型,考虑其传感器故障,建立四旋翼无人机姿态传感器故障模型;
步骤2:基于四旋翼无人机姿态传感器故障模型,将四旋翼姿态和传感器故障增广,得到新的增广系统;
步骤3:针对所得增广系统,设计广义观测器,从而实现对四旋翼无人机姿态和传感器故障的同时估计;
步骤4:基于广义观测器以及增广无人机姿态故障模型,得到姿态误差模型;
步骤5:将所得误差系统视为正系统,利用L1性能指标刻画鲁棒性,从而达到抑制干扰的效果,利用正系统理论求得观测器增益矩阵,实现对四旋翼无人机姿态和传感器故障的同时估计。
本实施例中对上述方法过程进行详细说明,具体为:
步骤1,首先给出四旋翼无人机动力学模型:
其中,J1,J2,J3为转动惯量;l为无人机质心与旋翼电机之间的距离;c为扭矩系数;ki(i=1,2,...,6)为空气阻力系数;wi(i=1,2,...,6)为外输入扰动;ui(i=1,2,...,4)为控制输入;m为无人机质量;g为重力加速度;x,y,z为三轴坐标;为无人机在相应坐标轴方向的速度;为无人机在相应坐标轴方向的加速度;φ,θ,为无人机姿态角,分别为滚转角,俯仰角,偏航角;为相应三个姿态角速度; 为相应三个姿态角加速度。
其中,x(t)为姿态系统状态量,为状态变量x(t)的导数,u(t)为控制量,d(t)为外部输入干扰,y(t)为系统输出,f(t)为传感器故障;矩阵A为系统矩阵,矩阵B为输入矩阵,矩阵C为输出矩阵,矩阵D为外部扰动矩阵,且各矩阵具体形式如下:
步骤3,针对上述增广系统⑷,设计如下广义观测器:
其中,C0=[C 0]。若下式成立
其中,为的导数。将公式⑹代入公式⑺可得从而由公式⑺可得若公式⑻成立,设计其中为非奇异矩阵,则上标-1表示对矩阵求逆。定义w(t)=[uT(t) dT(t)]T,且和为矩阵的分块。则根据公式⑼可得误差导数:
其中,
其中,sup表示上确界,||·||1表示向量的一范数,w(t)∈L1[0,∞)表示w(t)属于L1[0,∞)空间,∞表示无穷大,L1性能指标γ为给定正数。γ越小,抗干扰性能越强,外输入干扰对四旋翼姿态及传感器故障估计的影响就越小。
只要误差系统⑽为正系统,渐进稳定且满足L1性能(鲁棒稳定),就能保证无人机姿态估计误差以及传感器故障估计误差收敛到零,并且使得外输入干扰对四旋翼姿态及传感器故障估计的影响尽可能小。
这里需要强调的是,误差系统⑽为正系统,即线性连续系统为正系统的条件为:
在此基础上,误差系统⑽为正系统,且渐进稳定且满足L1性能的条件为:
1TP1D-1TP2CD-1Tγ<0
其中,1表示元素全为1的列向量,符号″<″表示位于其左边的矩阵各元素小于其右边矩阵对应元素,符号″≥″表示位于其左边的矩阵各元素不小于其右边矩阵对应元素。根据条件1中各式,利用YALMIP工具箱,可直接求得矩阵P1,P2,以及进一步可得从而,由此得到观测器增益矩阵以及
本实施例中通过上述设计并计算求得的广义观测器,在外输入干扰存在的情况下,亦能有效地同时估计出无人机姿态信息与传感器故障信息。
Claims (9)
1.一种基于广义观测器的四旋翼无人机故障估计方法,其特征在于:包括如下步骤:
S1:针对四旋翼无人机动力学系统模型,考虑其传感器故障,建立四旋翼无人机姿态传感器故障模型;
S2:基于四旋翼无人机姿态传感器故障模型,将四旋翼姿态和传感器故障增广,得到新的增广系统;
S3:针对所得新的增广系统,设计广义观测器,用于实现对四旋翼无人机姿态和传感器故障的同时估计;
S4:基于广义观测器以及增广无人机姿态故障模型,得到姿态误差模型;
S5:将姿态误差模型的误差系统视为正系统,且利用L1性能指标刻画鲁棒性,利用正系统理论求得观测器增益矩阵,实现对四旋翼无人机姿态和传感器故障的同时估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010541600.4A CN111722614B (zh) | 2020-06-15 | 2020-06-15 | 一种基于广义观测器的四旋翼无人机故障估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010541600.4A CN111722614B (zh) | 2020-06-15 | 2020-06-15 | 一种基于广义观测器的四旋翼无人机故障估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111722614A true CN111722614A (zh) | 2020-09-29 |
CN111722614B CN111722614B (zh) | 2021-07-09 |
Family
ID=72566808
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010541600.4A Active CN111722614B (zh) | 2020-06-15 | 2020-06-15 | 一种基于广义观测器的四旋翼无人机故障估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111722614B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116224807A (zh) * | 2023-05-08 | 2023-06-06 | 西北工业大学 | 一种基于分布式观测器的无人机编队故障检测方法 |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101241653A (zh) * | 2008-03-21 | 2008-08-13 | 北京航空航天大学 | 一种用于飞行模拟训练的故障模拟方法 |
CN101858826A (zh) * | 2009-04-09 | 2010-10-13 | 通用电气公司 | 用于监测涡轮发动机的健康的系统和方法 |
CN103529830A (zh) * | 2013-11-05 | 2014-01-22 | 南京航空航天大学 | 一种基于有限频域飞行控制系统渐变故障的诊断设计方法 |
US20140172245A1 (en) * | 2011-01-21 | 2014-06-19 | United States Of America As Represented By The Secretary Of The Navy | Vehicle damage detection system and method of manufacturing the same |
CN104022742A (zh) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | 基于神经网络观测器的飞行器姿态鲁棒反演容错控制方法 |
CN104535065A (zh) * | 2014-12-23 | 2015-04-22 | 广州快飞计算机科技有限公司 | 无人机飞行器在复杂磁场环境下的航向生成方法 |
CN104639398A (zh) * | 2015-01-22 | 2015-05-20 | 清华大学 | 基于压缩测量数据检测系统故障的方法及系统 |
CN105204499A (zh) * | 2015-10-09 | 2015-12-30 | 南京航空航天大学 | 基于未知输入观测器的直升机协同编队故障诊断方法 |
CN106200629A (zh) * | 2016-09-30 | 2016-12-07 | 山东科技大学 | 一种无人机飞行控制系统的故障可检测度分析方法 |
KR20170104186A (ko) * | 2016-03-07 | 2017-09-15 | 김봉겸 | 위치정보를 제공하는 도킹스테이션과 도킹 충전식 무인항공기 및 그 운용시스템 |
CN107272653A (zh) * | 2017-07-20 | 2017-10-20 | 南京航空航天大学 | 一种飞行控制系统故障诊断方法 |
CN108196532A (zh) * | 2018-03-07 | 2018-06-22 | 山东科技大学 | 一种基于非线性自适应观测器的无人机纵向飞行控制系统故障检测与分离方法 |
CN108508458A (zh) * | 2018-03-05 | 2018-09-07 | 中南大学 | 基于机间测距的无人机gps定位故障检测与重构方法 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
CN109885080A (zh) * | 2013-11-27 | 2019-06-14 | 宾夕法尼亚大学理事会 | 自主控制系统及自主控制方法 |
-
2020
- 2020-06-15 CN CN202010541600.4A patent/CN111722614B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101241653A (zh) * | 2008-03-21 | 2008-08-13 | 北京航空航天大学 | 一种用于飞行模拟训练的故障模拟方法 |
CN101858826A (zh) * | 2009-04-09 | 2010-10-13 | 通用电气公司 | 用于监测涡轮发动机的健康的系统和方法 |
US20140172245A1 (en) * | 2011-01-21 | 2014-06-19 | United States Of America As Represented By The Secretary Of The Navy | Vehicle damage detection system and method of manufacturing the same |
CN103529830A (zh) * | 2013-11-05 | 2014-01-22 | 南京航空航天大学 | 一种基于有限频域飞行控制系统渐变故障的诊断设计方法 |
CN109885080A (zh) * | 2013-11-27 | 2019-06-14 | 宾夕法尼亚大学理事会 | 自主控制系统及自主控制方法 |
CN104022742A (zh) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | 基于神经网络观测器的飞行器姿态鲁棒反演容错控制方法 |
CN104535065A (zh) * | 2014-12-23 | 2015-04-22 | 广州快飞计算机科技有限公司 | 无人机飞行器在复杂磁场环境下的航向生成方法 |
CN104639398A (zh) * | 2015-01-22 | 2015-05-20 | 清华大学 | 基于压缩测量数据检测系统故障的方法及系统 |
CN105204499A (zh) * | 2015-10-09 | 2015-12-30 | 南京航空航天大学 | 基于未知输入观测器的直升机协同编队故障诊断方法 |
KR20170104186A (ko) * | 2016-03-07 | 2017-09-15 | 김봉겸 | 위치정보를 제공하는 도킹스테이션과 도킹 충전식 무인항공기 및 그 운용시스템 |
CN106200629A (zh) * | 2016-09-30 | 2016-12-07 | 山东科技大学 | 一种无人机飞行控制系统的故障可检测度分析方法 |
CN107272653A (zh) * | 2017-07-20 | 2017-10-20 | 南京航空航天大学 | 一种飞行控制系统故障诊断方法 |
CN108508458A (zh) * | 2018-03-05 | 2018-09-07 | 中南大学 | 基于机间测距的无人机gps定位故障检测与重构方法 |
CN108196532A (zh) * | 2018-03-07 | 2018-06-22 | 山东科技大学 | 一种基于非线性自适应观测器的无人机纵向飞行控制系统故障检测与分离方法 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
Non-Patent Citations (6)
Title |
---|
刘国胜: "分布式飞行控制系统故障诊断研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
张小敏: "基于神经网络的飞控传感器故障诊断", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
张栋 等: "基于多模型参数估计的舵机故障诊断算法", 《光电与控制》 * |
沈俊: "直升机飞行控制实时仿真研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
王俭臣 等: "基于气动参数辨识的飞控系统传感器故障估计", 《兵工学报》 * |
钱默抒 等: "基于极大后验原理的非线性系统传感器故障估计", 《南京航空航天大学学报》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116224807A (zh) * | 2023-05-08 | 2023-06-06 | 西北工业大学 | 一种基于分布式观测器的无人机编队故障检测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111722614B (zh) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9650152B2 (en) | Flight envelope protection system for unmanned aerial vehicles | |
CN111766899B (zh) | 一种基于干扰观测器的四旋翼无人机集群抗干扰编队控制方法 | |
Zhou et al. | Fixed-time observer based safety control for a quadrotor UAV | |
Hasan et al. | Model-based actuator fault diagnosis in multirotor UAVs | |
CN108803317B (zh) | 自适应多变量四旋翼无人机有限时间容错控制方法 | |
CN110161847B (zh) | 一种基于分布式奇异观测器的无人机编队系统传感器故障估计方法 | |
CN111880410B (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
CN108647442B (zh) | 一种基于辅助输出的六旋翼无人机故障估计方法 | |
Demitrit et al. | Model-based wind estimation for a hovering VTOL tailsitter UAV | |
Xiang et al. | Wind field estimation through autonomous quadcopter avionics | |
CN115657730B (zh) | 一种大规模多旋翼无人机鲁棒分簇编队控制方法 | |
CN112684705B (zh) | 一种四旋翼飞行器编队追踪控制方法 | |
CN111722614B (zh) | 一种基于广义观测器的四旋翼无人机故障估计方法 | |
CN106292297A (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
Li et al. | Robust actuator fault detection for quadrotor UAV with guaranteed sensitivity | |
Guisser et al. | A high gain observer and sliding mode controller for an autonomous quadrotor helicopter | |
Arantes et al. | Evaluating hardware platforms and path re-planning strategies for the UAV emergency landing problem | |
CN115167147A (zh) | 一种基于推力残差估计的蜂群无人机分布式故障诊断方法 | |
CN115328200A (zh) | 基于状态估计的飞行器集群系统的一致性控制方法 | |
Li et al. | Small UAV autonomous localization based on multiple sensors fusion | |
CN112882388B (zh) | 一种执行器受损下的四旋翼无人机故障检测与诊断方法 | |
Kriegleder et al. | Distributed altitude and attitude estimation from multiple distance measurements | |
Hasanshahi et al. | Robust fault tolerant position tracking control for a quadrotor UAV in presence of actuator faults | |
CN117148863B (zh) | 一种复合故障下的集群无人机容错协同控制方法 | |
Peng et al. | Velocity Prediction Method of Quadrotor UAV Based on BP Neural Network |
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 |