CN103048991A - 三自由度直升机***故障估计观测器及容错控制方法 - Google Patents
三自由度直升机***故障估计观测器及容错控制方法 Download PDFInfo
- Publication number
- CN103048991A CN103048991A CN2013100063896A CN201310006389A CN103048991A CN 103048991 A CN103048991 A CN 103048991A CN 2013100063896 A CN2013100063896 A CN 2013100063896A CN 201310006389 A CN201310006389 A CN 201310006389A CN 103048991 A CN103048991 A CN 103048991A
- Authority
- CN
- China
- Prior art keywords
- fault
- matrix
- degree
- overbar
- fault estimation
- 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.)
- Pending
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
Description
技术领域
本发明属于直升机容错控制技术领域,具体涉及一种三自由度直升机***故障估计观测器及容错控制方法。
背景技术
直升机是一种以动力装置驱动的旋翼作为主要升力和推进力来源,能垂直起落及前后、左右飞行的旋翼航空器。相比较于固定翼飞行器,直升机本身有其一些独有的特点,比如直升机可以做低空、低速和机头方向不变的机动飞行,尤其可在非常小面积场地垂直起降。直升机的这些特点使得其不仅在军事方面有广泛的应用,而且在民用方面也日益普及。直升机飞行控制***是直升机的重要组成部分,对于直升机的飞行性能和安全性能起着异常重要的作用。目前,随着世界各国对高性能直升机的迫切需求,直升机飞行控制***的重要性日益受到重视。同时,直升机在飞行过程中不可避免的会受到外界干扰、输入噪声,以及直升机自身气动特性变化,甚至执行器、传感器或元部件故障等因素影响直接影响直升机飞行性能和安全性能。因此,研究直升机***的可靠性与安全性具有十分重要的实际意义和研究价值。
基于自适应观测器的故障估计的一个显著特点是在***发生故障时,通过自适应观测器能够将***的状态向量和发生的故障同时估计出来,尤其适用于很多状态向量不完全可测量的***。但是,自适应观测器需要满足严格正实条件,同时它也不能很好地处理输出存在扰动的不确定性***。经过研究发现,并不是所有的***均可适用自适应观测器进行故障估计,它是具有特定的适用范围,即严格正实条件。由于三自由度直升机***平台仅有三个角度(升降角、俯仰角和航向角)可测量,它们的角速率不可测量,也就是误差动态方程中矩阵(A、E、C)不满足严格正实条件,目前常用的自适应观测器不适用此***。因此如何在保留自适应观测器能够将状态向量和发生的故障同时估计出来优点的情况下,拓宽它的适用范围还有待进一步研究。
发明内容
本发明所要解决的技术问题在于克服现有自适应观测器无法应用于三自由度直升机***的不足,提供一种三自由度直升机***故障估计观测器及容错控制方法,可以放松自适应观测器需要苛刻的严格正实条件的限制,对三自由度直升机***进行实时在线地故障估计,进而可根据故障估计结果对故障所造成的***影响进行补偿控制。
本发明具体采用以下技术方案解决上述技术问题:
一种三自由度直升机***故障估计观测器,所述故障估计观测器为全阶故障估计观测器,具体如下:
其中,和分别是故障估计观测器的状态向量和测量输出向量;是故障估计值,A、B、C分别为所述三自由度直升机***的状态矩阵、输入矩阵、输出矩阵;矩阵E是故障分布矩阵;适维矩阵L和F是所述故障估计观测器的增益矩阵,按照以下方法得到:
令: 则误差动态方程表示为:
式中,D1、D2分别为所述三自由度直升机***的输入、输出扰动的分布矩阵;
定义:
则误差动态方程表示:
一种三自由度直升机***容错控制方法,利用上述故障估计观测器对***故障进行故障估计,并根据故障估计结果对所述三自由度直升机***进行重构控制。
相比现有技术,本发明具有以下有益效果:
1.由于三自由度直升机***平台仅有三个角度(升降角、俯仰角和航向角)可测量,它们的角速率不可测量,也就是误差动态方程中矩阵A、E、C不满足严格正实条件,目前常用的自适应观测器不适用此***。另外,由于该直升机平台具有非常大的应用范围,故该平台故障估计观测器的设计极少。针对该问题,本发明提出的全阶故障估计观测器不再需要矩阵A、E、C满足严格正实条件,故其具有更为广泛的应用范围。
2.基于本发明全阶故障估计观测器在线获取的故障估计值,设计容错控制以补偿***中出现的故障对***产生的影响。相比较于***自带镇定控制,基于故障估计观测器的容错控制明显提升了该***的稳定性。
附图说明
图1为三自由度直升机的控制***结构框图;
图2为三自由度直升机***的动力学模型;
图3为正常控制作用下的升降角响应曲线,其中虚线代表升降角指令,实线代表有故障时正常控制作用下升降角响应曲线;
图4为在本发明的重构控制方法作用下的升降角响应曲线,其中虚线代表升降角指令,实线代表有故障时重构控制作用下升降角响应曲线;
图5为正常控制作用下的航向角响应曲线,其中虚线代表航向角指令,实线代表有故障时正常控制作用下航向角响应曲线;
图6为在本发明的重构控制方法作用下的升降角响应曲线,其中虚线代表升降角指令,实线代表有故障时重构控制作用下升降角响应曲线;
图7为前向推进器故障估计曲线,其中虚线代表实际故障,实线代表故障估计值。
具体实施方式
下面结合附图对本发明的技术方案进行详细说明:
本发明以三自由度直升机飞控***平台为研究对象,提出了新颖的多约束全阶故障估计观测器,设计的全阶故障估计观测器可以实时在线进行故障估计,并基于故障估计信息设计重构控制器以补偿故障对***带来的影响,确保了***在发生故障时的性能。
首先,介绍三自由度直升机平台组成部分。图1显示了本发明的三自由度直升机的控制***结构框图,如图所示,整个***包括硬件模块和软件模块两部分。硬件模块包括三自由度直升机、计算机、功率放大器和两个数据采集卡,计算机将输出的信号通过功率放大器与三自由度直升机***连接,该三自由度直升机同时通过数据采集卡与计算机相连接。而软件模块包括模拟故障注入、决策机制、故障信息和重构控制这四个模块。
更详细的说,本发明的装置由以下几部分组成:
①硬件模块主要包括两旋翼直升机机体,功率放大器,数据采集卡,电源模块等;
②软件模块主要包括模拟故障注入模块、决策机制,故障信息,重构控制模块等;
人机交互界面设计,采用Quanser公司的基于Matlab/Simulink在线实时数字过程控制软件Wincon。它首先在Matlab/Simulink中运行,并直接产生代码,它包含客户端和服务器两部分代码,将检测的故障状况显示在设计的界面上并保存。
对于三自由度直升机***,应用Eular-Lagrange方法,建立直升机动力学模型,如图2所示,可以得到三自由度直升机***的非线性运动方程。进一步通过线性化,可以得到如下的在平衡位置的线性方程:
其中,状态向量分别是升降角、俯仰角、航向角和它们的角速度。输入向量是前推进器和后推进器的输入电压。输出向量分别是升降角、俯仰角和航向角。各个矩阵表示如下:
假设三自由度直升机***发生执行器故障。由于执行器故障发生在控制输入通道,故令故障分布矩阵E=B。假定***的输入、输出扰动的分布矩阵分别是D1=[1,1,1,1,1,1]T和D2=[1,1,1]T。建立一般故障模型如下:
为了估计故障,本发明设计了如下故障估计观测器:
其中,和分别是故障估计观测器的状态向量和测量输出向量;是故障估计值,A、B、C分别为所述三自由度直升机***的状态矩阵、输入矩阵、输出矩阵;适维矩阵L和F是所述故障估计观测器的增益矩阵,按照以下方法得到:
令:
则误差动态方程表示为:
式中,D1、D2分别为所述三自由度直升机***的输入、输出扰动的分布矩阵;
定义:
则误差动态方程表示:
则的特征根位于圆盘区域且误差动态***满足H∞性能||ef(t)||2<γ1||v(t)||2,则根据 即可得到所述故障估计观测器的增益矩阵L和F。利用该故障估计观测器即可对三自由度直升机***进行实时在线的故障估计。
由此可见,相比较于自适应观测器,本发明提出的全阶故障估计观测器具有更宽广的应用范围。
根据上述故障估计观测器输出的故障估计结果可对所述三自由度直升机***进行重构控制。由于***内带的控制是最优控制,在这里我们仅考虑在正常控制器输入端减掉在线的故障估计值,补偿故障对***产生的影响,以验证重构控制的作用。
为了验证本发明三自由度直升机***控制方法的效果,进行了以下仿真验证来比较现有的镇定控制方法和本发明提出的容错控制方法。镇定控制方法可参见文献(QuanserInc.3-DOF Helicopter Reference Manual.Docunment Number644/Revision2.11,Canada:Quanser Inc,2007),而本发明设计的容错控制器是基于本发明的故障估计观测器设计的,在现有的镇定控制器中减去执行器故障的在线估计值。
假设执行器发生如下的故障f(t)=[f1(t),f2(t)]T:
也就是,在30s时,在前向推进器中加入-5V的电压,模拟加性的执行器故障。
实验结果如图3~图7所示。图3和图4分别为两种控制方法所得到的升降角的响应曲线。图5和图6分别为两种控制方法所得到的航向角的响应曲线。图7给出了故障估计曲线。从实验结果可以看出,尽管rank(CE)=0<2,自适应观测器不能应用到此***中去,但是本发明提出的全阶故障估计观测器能够实现准确的故障估计。同时基于在线的故障估计,通过反馈补偿可以使直升机飞控***在出现故障时仍能保持良好的性能。
本发明可以有效的实现三自由度直升机***故障的估计,且能够对出现的故障进行容错,使***在故障情况下依然能保持稳定性或较好的性能,这对于***故障的预警和实时监控具有重要的意义。
Claims (2)
1.一种三自由度直升机***故障估计观测器,其特征在于,所述故障估计观测器为全
阶故障估计观测器,具体如下:
其中,和分别是故障估计观测器的状态向量和测量输出向量;是故障估计值,、、分别为所述三自由度直升机***的状态矩阵、输入矩阵、输出矩阵;矩阵是故障分布矩阵;适维矩阵和是所述故障估计观测器的增益矩阵,按照以下方法得到:
则误差动态方程表示为:
定义:
则误差动态方程表示:
2.一种三自由度直升机***容错控制方法,其特征在于,利用权利要求1所述故障估计观测器对***故障进行在线故障估计,并根据故障估计结果对所述三自由度直升机***进行重构控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013100063896A CN103048991A (zh) | 2013-01-08 | 2013-01-08 | 三自由度直升机***故障估计观测器及容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013100063896A CN103048991A (zh) | 2013-01-08 | 2013-01-08 | 三自由度直升机***故障估计观测器及容错控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103048991A true CN103048991A (zh) | 2013-04-17 |
Family
ID=48061668
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013100063896A Pending CN103048991A (zh) | 2013-01-08 | 2013-01-08 | 三自由度直升机***故障估计观测器及容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103048991A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104267716A (zh) * | 2014-09-15 | 2015-01-07 | 南京航空航天大学 | 一种基于多智能体技术的分布式飞行控制***故障诊断设计方法 |
CN104765273A (zh) * | 2014-12-31 | 2015-07-08 | 南京航空航天大学 | 一种针对线性参数变化飞行器的自修复控制方法 |
CN108170155A (zh) * | 2018-01-14 | 2018-06-15 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN111609878A (zh) * | 2020-06-10 | 2020-09-01 | 江南大学 | 三自由度直升机***传感器运行状态监测方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102809970A (zh) * | 2012-07-09 | 2012-12-05 | 北京理工大学 | 一种基于l1自适应控制的飞行器姿态控制方法 |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
-
2013
- 2013-01-08 CN CN2013100063896A patent/CN103048991A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102809970A (zh) * | 2012-07-09 | 2012-12-05 | 北京理工大学 | 一种基于l1自适应控制的飞行器姿态控制方法 |
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
Non-Patent Citations (3)
Title |
---|
KE ZHANG等: "Dynamic Output Feedback-Fault Tolerant Controller Design for Takagi–Sugeno Fuzzy Systems With Actuator Faults", 《IEEE TRANSACTIONS ON FUZZY SYSTEMS》, vol. 18, no. 1, 28 February 2010 (2010-02-28), pages 194 - 201 * |
KE ZHANG等: "Fault Estimation Observer Design for Discrete-Time Takagi–Sugeno Fuzzy Systems Based on Piecewise Lyapunov Functions", 《IEEE TRANSACTIONS ON FUZZY SYSTEMS》, vol. 20, no. 1, 28 February 2012 (2012-02-28), pages 192 - 200 * |
张柯等: "基于故障诊断观测器的输出反馈容错控制设计", 《自动化学报》, vol. 36, no. 2, 28 February 2010 (2010-02-28), pages 274 - 281 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104267716A (zh) * | 2014-09-15 | 2015-01-07 | 南京航空航天大学 | 一种基于多智能体技术的分布式飞行控制***故障诊断设计方法 |
CN104267716B (zh) * | 2014-09-15 | 2017-03-01 | 南京航空航天大学 | 一种基于多智能体技术的分布式飞行控制***故障诊断设计方法 |
CN104765273A (zh) * | 2014-12-31 | 2015-07-08 | 南京航空航天大学 | 一种针对线性参数变化飞行器的自修复控制方法 |
CN104765273B (zh) * | 2014-12-31 | 2017-05-10 | 南京航空航天大学 | 一种针对线性参数变化的飞行器的自修复控制方法 |
CN108170155A (zh) * | 2018-01-14 | 2018-06-15 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN108170155B (zh) * | 2018-01-14 | 2021-04-06 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN111609878A (zh) * | 2020-06-10 | 2020-09-01 | 江南大学 | 三自由度直升机***传感器运行状态监测方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100587761C (zh) | 一种用于无人机飞行模拟训练的故障模拟方法 | |
CN103488092B (zh) | 基于t-s模糊模型与学习观测器的卫星故障诊断与容错控制方法 | |
Du et al. | Controllability analysis for multirotor helicopter rotor degradation and failure | |
CN111024143A (zh) | 一种高超声速飞行器传感器连锁故障诊断与容错控制方法 | |
CN103135553B (zh) | 四旋翼飞行器容错控制方法 | |
CN104965414A (zh) | 针对四旋翼无人机执行器部分失效的容错控制方法 | |
De Loza et al. | Sensor fault diagnosis using a non‐homogeneous high‐order sliding mode observer with application to a transport aircraft | |
CN103838145A (zh) | 基于级联观测器的垂直起降飞机鲁棒容错控制***及方法 | |
Hodge et al. | Simulating the environment at the helicopter-ship dynamic interface: research, development and application | |
CN110513198A (zh) | 一种涡扇发动机控制***主动容错控制方法 | |
Tousi et al. | Robust observer-based fault diagnosis for an unmanned aerial vehicle | |
CN104765312A (zh) | 飞行器可重构控制***实现方法 | |
CN103048991A (zh) | 三自由度直升机***故障估计观测器及容错控制方法 | |
CN103482061B (zh) | 直升机结构响应自适应控制的谐波同步识别修正法 | |
JP6176717B2 (ja) | 航空機運航用情報生成装置、航空機運航用情報生成方法、及び航空機運航用情報生成プログラム | |
CN106019937B (zh) | 一种混杂***的抗干扰控制方法 | |
Cristofaro et al. | Icing detection and identification for unmanned aerial vehicles: Multiple model adaptive estimation | |
CN104290919A (zh) | 一种四旋翼飞行器的直接自修复控制方法 | |
Hsiao et al. | Mavfi: An end-to-end fault analysis framework with anomaly detection and recovery for micro aerial vehicles | |
CN104020670A (zh) | 基于支持向量机的三自由度直升机容错控制装置及方法 | |
CN103149929B (zh) | 飞行器纵向运动故障诊断和容错控制方法 | |
CN108345212A (zh) | 一种基于滑模的三自由度直升机的鲁棒h∞控制方法 | |
CN117452831B (zh) | 一种四旋翼无人机控制方法、装置、***及存储介质 | |
Christmann et al. | Innovative approaches to electromechanical flight control actuators and systems | |
CN109358491A (zh) | 基于卡尔曼滤波的模糊pid故障确定容错控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C12 | Rejection of a patent application after its publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20130417 |