CN115509136A - 一种面向线性传感器故障无人机飞行容错控制系统及方法 - Google Patents
一种面向线性传感器故障无人机飞行容错控制系统及方法 Download PDFInfo
- Publication number
- CN115509136A CN115509136A CN202211454851.4A CN202211454851A CN115509136A CN 115509136 A CN115509136 A CN 115509136A CN 202211454851 A CN202211454851 A CN 202211454851A CN 115509136 A CN115509136 A CN 115509136A
- Authority
- CN
- China
- Prior art keywords
- matrix
- fault
- unmanned aerial
- aerial vehicle
- control
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (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
技术领域
本发明属于无人机的容错控制技术领域,涉及一种面向线性传感器故障无人机飞行容错控制系统及方法。
背景技术
近十年来无人机在各个领域得到了广泛的应用,根据任务类型以及飞行环境的不同,衍生出许多类型的无人机,最常见的是四旋翼无人机和固定翼无人机。但四旋翼无人机飞行速度低、航程短且有效载荷小,限制了它的发展,因此对飞行速度、飞行航程以及载重有一定要求的飞行任务而言,固定翼无人机仍然是首选机型。对于固定翼无人机而言,其飞行高度高且飞行速度快,自然发生安全事故的概率和风险都很大,因此在设计开发固定翼无人机飞控系统时,必须考虑到关键的安全问题。其中,传感器作为极易发生故障且在控制方面发挥重要作用的部件,研究针对传感器故障的容错控制系统就更加需要引起关注。
线性传感器是无人机上最常见的传感器种类之一,又称为位移传感器,是一种属于金属感应的线性器件,作用是把各种被测物理量转换为电量。线性传感器常见的故障包括:密封老化、供电不足、静电干扰以及对地短路等等。
针对线性传感器故障,已经有一些方法被提出用于解决这个问题。这些方法主要分为两大类:故障的诊断以及容错控制。其中针对线性传感器故障的容错控制,又可以分为两类:主动容错控制和被动容错控制。对于被动容错控制技术而言,发生的传感器故障可以看作是一种扰动,而对于主动容错来说,是将发生的传感器故障整合进控制率的设计中,但无论是主动容错还是被动容错,都只是在故障发生时产生信号,难以对故障及时响应,并对故障进行对应处理。
发明内容
本发明的目的在于解决现有技术中的问题,提供一种面向线性传感器故障无人机飞行容错控制系统及方法,以解决现有技术中线性传感器发生故障时,控制系统只能产生信号,难以对故障及时响应,并对故障进行对应处理的问题。
为达到上述目的,本发明采用以下技术方案予以实现:
一种面向线性传感器故障无人机飞行容错控制方法,包括以下步骤:
步骤1,建立无人机稳定平飞时的动力学模型;采集无人机系统的状态信息,通过无人机系统的状态信息获取无人机系统的状态矩阵;
步骤2,基于动力学模型,建立以标称控制律表达的控制输入,所述控制输入为无人机系统的控制输入;将标称控制律中的增益矩阵引入至候选李亚普诺夫函数中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵,结合无人机系统的状态矩阵,获得各个控制通道的以标称控制律表达的控制输入,为求解后的标称控制律;
步骤3,基于求解后标称控制律,建立引入自适应容错控制器的控制输入,引入自适应容错控制器的控制输入中有线性传感器故障估计值;通过数据投影方法获得线性传感器故障估计值后,将所述线性传感器故障估计值输入至引入自适应容错控制器的控制输入中,结合无人机稳定平飞时的动力学模型,获得线性传感器故障的无人机飞行容错控制输出,无人机系统的各个控制通道按照无人机飞行容错控制输出执行。
本发明的进一步改进在于:
优选的,步骤1中,所述动力学模型的公式为:
式中,x(k)为k时刻无人机状态矩阵,,为m阶方阵,x(k+1)为k+1
时刻无人机状态矩阵;u(k)为k时刻无人机的控制输入,,为n阶方阵;y(k)为k
时刻无人机系统的动力学模型控制输出,,为h阶方阵;f s,k 为线性传感器故
障,σ(k)为指令信号,σ(k)∈{1,2,...,M},M为控制通道的数量;A σ(k)、B σ(k)、C σ(k)均为常数矩
阵,其中,当第i个控制通道启动时,σ(k)=i、A σ(k)=A i 、B σ(k)=B i 且C σ(k)=C i 。
优选的,步骤2中,所述以标称控制律表达的控制输入如下式(2),
优选的,步骤2中,将增益矩阵引入至候选李亚普诺夫函数的公式为:
其中,ΔV(x)为候选李亚普诺夫函数的增量表达式,x T (k)为k时刻无人机状态矩
阵的转置矩阵,A i 为第i个A矩阵;B i 为第i个B矩阵,为第i个A矩阵的转置矩阵,为第i
个B矩阵的转置矩阵,K i 为无人机各个控制通道的增益矩阵,为增益矩阵K i 的转置矩阵,S
为中间变量。
优选的,步骤2中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵的过程为:
根据候选李亚普诺夫函数的性质,如果一个系统稳定,满足以下表达式(4),
其中,V(x(k))为k时刻无人机状态矩阵的候选李亚普诺夫函数值,V(x(k+1))为k+1时刻无人机状态矩阵的候选李亚普诺夫函数值,x(k+1)为k+1时刻无人机状态矩阵;
若要满足式(4),K i 和S要求满足下式(8),
基于式(8),进行变量变换,得到下式(9),
式中,S T 为式(7)中中间变量S的转置,H i 是一个矩阵;
基于式(9),所述矩阵线性不等式如下式(10)所示,
求解式(10),得到K i 。
优选的,步骤3中,所述引入自适应容错控制器的控制输入,如下式(11),
其中,K i 为无人机各个控制通道的增益矩阵,x(k)为k时刻无人机状态矩阵,Ze(k)为k时刻的积分误差,G i 为Ze(k)对应的增益矩阵,u add (k)为k时刻的自适应容错控制器补偿的控制输入;
在式(11)中引入线性传感器故障估计值,如下式(14),
优选的,步骤3中,通过数据投影方法获得线性传感器故障估计值的过程为:
基于数据投影方法,输入数据库的表达式如下式(17)所示,
式中,L和j是两个整数,并且满足L>n×j;为动力学模型中第kk-L+1个
含有加性容错控制的输入,为第kk-L+2个含有加性容错控制的输入, 为
第kk个含有加性容错控制的输入,为尺寸为n(j+1)×1的实数矩阵;
基于数据投影方法,输出数据库的表达式如下式(18)所示,
将输出数据库投影到输入数据库的正交空间中,获得投影矩阵表达式,如下式(19)所示:
基于投影矩阵计算线性传感器故障估计值,具体的计算公式如下式(20)所示:
优选的,所述输入数据库的表达式(17)的获取过程为:
将式(11)代入式(15)得到:
通过式(16)获得输入数据库的表达式(17)。
优选的,所述控制通道包括俯仰、偏航、滚转、速度和高度。
一种面向线性传感器故障无人机飞行容错控制系统,包括:
动力学模型模块,用于建立无人机稳定平飞时的动力学模型;采集无人机系统的状态信息,通过无人机系统的状态信息获取无人机系统的状态矩阵;
标称控制律模块,用于基于动力学模型,建立以标称控制律表达的控制输入,所述控制输入为无人机系统的控制输入;将标称控制律中的增益矩阵引入至候选李亚普诺夫函数中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵,结合无人机系统的状态矩阵,获得各个控制通道的以标称控制律表达的控制输入,为求解后的标称控制律;
容错控制器模块,用于基于求解后标称控制律,建立引入自适应容错控制器的控制输入,引入自适应容错控制器的控制输入中有线性传感器故障估计值;通过数据投影方法获得线性传感器故障估计值后,将所述线性传感器故障估计值输入至引入自适应容错控制器的控制输入中,结合无人机稳定平飞时的动力学模型,获得线性传感器故障的无人机飞行容错控制输出,无人机系统的各个控制通道按按照无人机飞行容错控制输出执行。
与现有技术相比,本发明具有以下有益效果:
本发明公开了一种面向线性传感器故障无人机飞行容错控制方法,该方法首先建立无人机稳定平飞时的动力学模型,然后在动力学模型基础上,设计标称控制律,并设计自适应容错控制器以获得传感器故障积分部分,通过计算线性传感器故障估计值,得到自适应容错控制器补偿的控制输入,将该补偿的控制输入补偿至标称控制律中,并结合动力学模型获得控制输出。本发明可以在线性传感器发生故障的情况下,使得对故障进行诊断时无需知道无人机系统的准确模型,利用估计误差的残差估计线性传感器的故障,并最后利用设计的自适应容错控制器补偿故障带来的控制输入损失。
本发明还公开了一种面向线性传感器故障无人机飞行容错控制系统,该系统包括动力学模型模块、标称控制律模块和容错控制器模块,首先通过动力学模型模块,建立无人机稳定平飞时的动力学模型;然后通过标称控制律模块,获得无人机稳定平飞时的以标称控制律表达的控制输入,最后通过容错控制器模块,在控制输入中引入自适应容错控制器,获得自适应容错控制器补偿的控制输入。通过该系统,对于可能发生线性传感器故障的无人机在发生故障的情况下,使得对故障进行诊断时无需知道无人机系统的准确模型,利用估计误差的残差估计线性传感器的故障,并利用自适应容错控制器补偿故障带来的控制输入损失。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明的控制方法示意图;
图2为本发明的控制逻辑示意图;
图3为本发明的发明提出的容错控制系统的仿真效果实验图一;
图4为本发明的发明提出的容错控制系统的仿真效果实验图二。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。
在本发明实施例的描述中,需要说明的是,若出现术语“上”、“下”、“水平”、“内”等指示的方位或位置关系为基于附图所示的方位或位置关系,或者是该发明产品使用时惯常摆放的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
此外,若出现术语“水平”,并不表示要求部件绝对水平,而是可以稍微倾斜。如“水平”仅仅是指其方向相对“竖直”而言更加水平,并不是表示该结构一定要完全水平,而是可以稍微倾斜。
在本发明实施例的描述中,还需要说明的是,除非另有明确的规定和限定,若出现术语“设置”、“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
下面结合附图和具体的实施例对本发明做进一步详细描述。
本发明公开了一种面向线性传感器故障无人机飞行容错控制系统及方法。该方法的基本思路为:首先建立固定翼无人机稳定平飞时的动力学模型,然后在无人机稳定平飞时的动力学模型基础上,设计自适应容错控制器以获得故障下的自适应控制输入,并将此自适应控制输入补偿进标称控制律中,最后通过基于数据投影方法估计线性传感器故障,获得线性传感器故障估计值,并实时地将估线性传感器故障估计值传输给自适应容错控制器中,以计算补偿控制输入,进而修复故障。对于可能发生线性传感器故障的系统,使用本发明提出的容错控制方法的优势在于,在发生故障的情况下,对故障进行诊断时无需知道无人机动力学的准确模型,利用估计误差的残差估计线性传感器故障,并最后利用设计的自适应容错控制器补偿故障带来的控制损失。
本发明的实施例之一为公开了一种面向线性传感器故障无人机飞行容错控制方法,参见图1和图2,所述无人机飞行容错控制方法包括以下步骤:
步骤1、建立固定翼无人机稳定平飞时,无人机系统的动力学模型,该模型采用平衡点附近线性化后的离散模型,表达式如下式(1)所示:
式中,x(k)为k时刻无人机状态矩阵,是一种状态信息,,为m阶
方阵;x(k+1)为k+1时刻无人机状态矩阵,是一种状态信息,为m阶方阵;u(k)为k时刻无
人机系统的控制输入,,为n阶方阵,控制输入为作动器指令;y(k)为k时刻无
人机系统的动力学模型控制输出,,为h阶方阵;f s,k 为线性传感器故障,σ
(k)为指令信号,σ(k)∈{1,2,...,M},M为控制通道的数量,A σ(k)、B σ(k)、C σ(k)均为常数矩阵,
其中,当第i个控制通道启动时,此时对应的σ(k)=i、A σ(k)=A i 、B σ(k)=B i 且C σ(k)=C i ;所述控制通
道包括俯仰、偏航、滚转、速度和高度。
首先设计标称控制律,标称控制律是基于状态反馈控制律进行设计的。无人机在稳定平飞状态下,无人机系统的控制输入以标称控制律表达时,即动力学模型的控制输入以标称控制律表达时的形式如下式(2)所示:
通过候选李亚普诺夫函数确定各个控制通道的增益矩阵,候选李亚普诺夫函数如下式(3)所示:
其中,V(x(k),k)为候选李亚普诺夫函数,x(k)为k时刻无人机状态矩阵,x T (k)为k时刻无人机状态矩阵的转置矩阵,S为中间变量,无实际意义,k为k时刻。
根据候选李亚普诺夫函数的性质,如果一个系统稳定,需要满足以下的公式(4):
式中,ΔV(x)为候选李亚普诺夫函数的增量表达式,V(x(k))为k时刻无人机状态矩阵的候选李亚普诺夫函数值,V(x(k+1))为k+1时刻无人机状态矩阵的候选李亚普诺夫函数值,x(k+1)为k+1时刻无人机状态矩阵。
结合上式(4)和候选李亚普诺夫函数的表达式(3),可以得到下式(5):
其中,x T (k+1)为k+1时刻无人机状态矩阵的转置矩阵。
在式(5)中代入步骤1中构建的平衡点附近线性化后的离散模型,即表达式(1),再结合式(2),得到下式(6):
式中,x T (k)为k时刻无人机状态矩阵的转置,为第i个A矩阵的转置矩阵,为
第i个B矩阵的转置矩阵,A矩阵和B矩阵分别来自式(1)中的常数矩阵A σ(k)和常数矩阵B σ(k),A i 为第i个A矩阵;B i 为第i个B矩阵,K i 为式(2)中无人机各个控制通道的增益矩阵,为增
益矩阵K i 的转置矩阵。
将式(6)简化得到下式(7):
上式(8)为双线性方程,为了从中获得线性不等式,做出如下式(9)的变量变换:
式中,S T 为式(3)中定义的中间变量S的转置,H i 为一个矩阵;为了求解增益矩阵K i ,在式(9)的基础上继续构建LMI不等式,即矩阵线性不等式,如下式(10)所示:
上式中,上标T代表矩阵转置。
通过求解上式(10)可以求得最终无人机各个控制通道各自的K i ,进一步的将K i 代入至式(2)中,获得各个K i 对应的标称控制律,更进一步的,俯仰、偏航、滚转、速度和高度都能够求得各自的标称控制律。
步骤3、在标称控制律基础上设计自适应容错控制器,获得故障下的自适应容错控制器补偿的控制输入,并将此补偿的控制输入补偿至标称控制律中。具体的过程为:
步骤3.1,在标称控制律的基础上,设计自适应容错控制器,具体的过程为:
引入自适应容错控制器时,无人机系统的控制输入的表达式为:
其中,Ze为积分误差,Ze(k)为k时刻的积分误差,G i 为Ze(k)对应的增益矩阵,u add 为自适应容错控制器补偿的控制输入,u add (k)为k时刻的自适应容错控制器补偿的控制输入。
Ze通过下式(12)进行计算:
其中,Ze(k+1)为k+1时刻的积分误差,T e 为采样时间间隔,y r e(k)为参考输入,y r e
(k)为是k时刻的参考输入,y(k)为k时刻无人机系统的动力学模型控制输出,,为h阶方阵;是式(1)中线性传感器故障f s,k 的积分部分,是k时刻线性传感器
故障f s,k 的积分部分,是Ze在没有故障时的值,是k时刻Ze(k)没有故障时的
值,f s,k (k-1)为k-1时刻线性传感器故障。
因此,k时刻的自适应容错控制器补偿的控制输入u add (k)的计算公式如下式(13)所示:
步骤3.2,通过数据投影方法求解线性传感器故障估计值。
步骤3.1中设计得到了完整的引入自适应容错控制器的无人机系统的控制输入的
表达式(14),但公式中的线性传感器故障估计值是未知的,因此提出一种基于数据投
影方法估计线性传感器故障,该方法具有在不知道数学模型的情况下生成故障值的优点。
具体步骤如下:
步骤3.2.1,基于数据投影方法构建固定翼无人机稳定平飞时的动力学模型输出
和输入。构建无人机系统的输出数据库和输入的数据库,即构建动力学模型控制输出数据
库和输入数据库,首先定义动力学模型的输入集合的表达式如下式(15):
将步骤3.1中引入自适应容错控制器时,无人机系统的控制输入表达式(11)代入上式(15)中,可得到下式(16),
因此基于数据投影方法,输入数据库的表达式如下式(17)所示,
同时,基于数据投影方法,输出数据库的表达式如下式(18)所示,
步骤3.2.2、利用上面得到的输入数据库和输出数据库的表达式,即式(17)和式
(18),可以得到系统残差用于估计线性传感器故障,即根据残差得知系统是否受到线性传
感器故障的影响。系统残差通过投影矩阵获得,投影矩阵为将输出数据库投影到输入数据
库的正交空间上的矩阵,该投影矩阵为通过与输入数据库右侧正交的空间中的
投影矩阵表达,如下式(19)所示:
因此,残差,即线性传感器故障,通过下面的式(20)进行估计。
参照图3和图4,本发明的容错控制方法进行了仿真实验,从实验结果可以看出,当故障发生时,标称控制律无法补偿该故障。另一方面,在存在此故障的情况下,使用附加容错控制,得到满意的性能。即使在故障发生时,该系统也达到了其设计目标。此外,该控制器能够快速取消故障。
本发明的实施例之一为公开了一种面向线性传感器故障无人机飞行容错控制系统,具体的,该系统包括:
动力学模型模块,用于建立无人机稳定平飞时的动力学模型;采集无人机系统的状态信息,通过无人机系统的状态信息获取无人机系统的状态矩阵;
标称控制律模块,用于基于动力学模型,建立以标称控制律表达的控制输入,所述控制输入为无人机系统的控制输入;将标称控制律中的增益矩阵引入至候选李亚普诺夫函数中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵,结合无人机系统的状态矩阵,获得各个控制通道的以标称控制律表达的控制输入,为求解后的标称控制律;
容错控制器模块,用于基于求解后标称控制律,建立引入自适应容错控制器的控制输入,引入自适应容错控制器的控制输入中有线性传感器故障估计值;通过数据投影方法获得线性传感器故障估计值后,将所述线性传感器故障估计值输入至引入自适应容错控制器的控制输入中,结合无人机稳定平飞时的动力学模型,获得线性传感器故障的无人机飞行容错控制输出,无人机系统的各个控制通道按照无人机飞行容错控制输出执行。
以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种面向线性传感器故障无人机飞行容错控制方法,其特征在于,包括以下步骤:
步骤1,建立无人机稳定平飞时的动力学模型;采集无人机系统的状态信息,通过无人机系统的状态信息获取无人机系统的状态矩阵;
步骤2,基于动力学模型,建立以标称控制律表达的控制输入,所述控制输入为无人机系统的控制输入;将标称控制律中的增益矩阵引入至候选李亚普诺夫函数中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵,结合无人机系统的状态矩阵,获得各个控制通道的以标称控制律表达的控制输入,为求解后的标称控制律;
步骤3,基于求解后标称控制律,建立引入自适应容错控制器的控制输入,引入自适应容错控制器的控制输入中有线性传感器故障估计值;通过数据投影方法获得线性传感器故障估计值后,将所述线性传感器故障估计值输入至引入自适应容错控制器的控制输入中,结合无人机稳定平飞时的动力学模型,获得线性传感器故障的无人机飞行容错控制输出,无人机系统的各个控制通道按照无人机飞行容错控制输出执行。
2.根据权利要求1所述的一种面向线性传感器故障无人机飞行容错控制方法,其特征在于,步骤1中,所述动力学模型的公式为:
5.根据权利要求4所述的一种面向线性传感器故障无人机飞行容错控制方法,其特征在于,步骤2中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵的过程为:
根据候选李亚普诺夫函数的性质,如果一个系统稳定,满足以下表达式(4),
其中,V(x(k))为k时刻无人机状态矩阵的候选李亚普诺夫函数值,V(x(k+1))为k+1时刻无人机状态矩阵的候选李亚普诺夫函数值,x(k+1)为k+1时刻无人机状态矩阵;
若要满足式(4),K i 和S要求满足下式(8),
基于式(8),进行变量变换,得到下式(9),
式中,S T 为式(7)中中间变量S的转置,H i 是一个矩阵;
基于式(9),所述矩阵线性不等式如下式(10)所示,
求解式(10),得到K i 。
7.根据权利要求6所述的一种面向线性传感器故障无人机飞行容错控制方法,其特征在于,步骤3中,通过数据投影方法获得线性传感器故障估计值的过程为:
基于数据投影方法,输入数据库的表达式如下式(17)所示,
式中,L和j是两个整数,并且满足L>n×j;为动力学模型中第kk-L+1个含有
加性容错控制的输入,为第kk-L+2个含有加性容错控制的输入, 为第kk
个含有加性容错控制的输入,为尺寸为n(j+1)×1的实数矩阵;
基于数据投影方法,输出数据库的表达式如下式(18)所示,
将输出数据库投影到输入数据库的正交空间中,获得投影矩阵表达式,如下式(19)所示:
基于投影矩阵计算线性传感器故障估计值,具体的计算公式如下式(20)所示:
9.根据权利要求1所述的一种面向线性传感器故障无人机飞行容错控制方法,其特征在于,所述控制通道包括俯仰、偏航、滚转、速度和高度。
10.一种面向线性传感器故障无人机飞行容错控制系统,其特征在于,包括:
动力学模型模块,用于建立无人机稳定平飞时的动力学模型;采集无人机系统的状态信息,通过无人机系统的状态信息获取无人机系统的状态矩阵;
标称控制律模块,用于基于动力学模型,建立以标称控制律表达的控制输入,所述控制输入为无人机系统的控制输入;将标称控制律中的增益矩阵引入至候选李亚普诺夫函数中,通过矩阵线性不等式求解候选李亚普诺夫函数中的增益矩阵,结合无人机系统的状态矩阵,获得各个控制通道的以标称控制律表达的控制输入,为求解后的标称控制律;
容错控制器模块,用于基于求解后标称控制律,建立引入自适应容错控制器的控制输入,引入自适应容错控制器的控制输入中有线性传感器故障估计值;通过数据投影方法获得线性传感器故障估计值后,将所述线性传感器故障估计值输入至引入自适应容错控制器的控制输入中,结合无人机稳定平飞时的动力学模型,获得线性传感器故障的无人机飞行容错控制输出,无人机系统的各个控制通道按照无人机飞行容错控制输出执行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211454851.4A CN115509136B (zh) | 2022-11-21 | 2022-11-21 | 一种面向线性传感器故障无人机飞行容错控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211454851.4A CN115509136B (zh) | 2022-11-21 | 2022-11-21 | 一种面向线性传感器故障无人机飞行容错控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115509136A true CN115509136A (zh) | 2022-12-23 |
CN115509136B CN115509136B (zh) | 2023-03-10 |
Family
ID=84514490
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211454851.4A Active CN115509136B (zh) | 2022-11-21 | 2022-11-21 | 一种面向线性传感器故障无人机飞行容错控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115509136B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104290919A (zh) * | 2014-09-25 | 2015-01-21 | 南京航空航天大学 | 一种四旋翼飞行器的直接自修复控制方法 |
CN107450328A (zh) * | 2017-10-12 | 2017-12-08 | 北京航空航天大学 | 一种基于e‑s滑模观测器的抗干扰容错控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
CN111024143A (zh) * | 2019-12-11 | 2020-04-17 | 南京航空航天大学 | 一种高超声速飞行器传感器连锁故障诊断与容错控制方法 |
US20210156314A1 (en) * | 2019-08-13 | 2021-05-27 | Dalian University Of Technology | Method for active fault tolerant control of turbofan engine control system |
CN112947392A (zh) * | 2021-04-05 | 2021-06-11 | 西北工业大学 | 一种基于鲁棒观测器的飞行控制系统执行器和传感器复合微小故障估计方法 |
CN114253137A (zh) * | 2021-12-16 | 2022-03-29 | 郑州大学 | 基于控制分配的无人机系统故障诊断与容错控制方法 |
-
2022
- 2022-11-21 CN CN202211454851.4A patent/CN115509136B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104290919A (zh) * | 2014-09-25 | 2015-01-21 | 南京航空航天大学 | 一种四旋翼飞行器的直接自修复控制方法 |
CN107450328A (zh) * | 2017-10-12 | 2017-12-08 | 北京航空航天大学 | 一种基于e‑s滑模观测器的抗干扰容错控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
US20210156314A1 (en) * | 2019-08-13 | 2021-05-27 | Dalian University Of Technology | Method for active fault tolerant control of turbofan engine control system |
CN111024143A (zh) * | 2019-12-11 | 2020-04-17 | 南京航空航天大学 | 一种高超声速飞行器传感器连锁故障诊断与容错控制方法 |
CN112947392A (zh) * | 2021-04-05 | 2021-06-11 | 西北工业大学 | 一种基于鲁棒观测器的飞行控制系统执行器和传感器复合微小故障估计方法 |
CN114253137A (zh) * | 2021-12-16 | 2022-03-29 | 郑州大学 | 基于控制分配的无人机系统故障诊断与容错控制方法 |
Non-Patent Citations (1)
Title |
---|
GÓMEZPEÑATE SAMUEL ET AL.: "Actuator and sensor fault estimation based on a proportional multiple‐integral sliding mode observer for linear parameter varying systems with inexact scheduling parameters" * |
Also Published As
Publication number | Publication date |
---|---|
CN115509136B (zh) | 2023-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Jin et al. | Robust adaptive hierarchical insensitive tracking control of a class of leader-follower agents | |
CN108375907B (zh) | 基于神经网络的高超声速飞行器自适应补偿控制方法 | |
Wang et al. | An adaptive sliding mode fault‐tolerant control of a quadrotor unmanned aerial vehicle with actuator faults and model uncertainties | |
CN108919651A (zh) | 一种考虑执行器输入约束的高超声速飞行器自适应容错控制方法 | |
CN110879535B (zh) | 一种t-s模糊umv的滑模容错控制方法 | |
Rotondo et al. | Robust fault and icing diagnosis in unmanned aerial vehicles using LPV interval observers | |
Vanek et al. | Bridging the gap between theory and practice in LPV fault detection for flight control actuators | |
CN111781942B (zh) | 一种基于自构造模糊神经网络的容错飞行控制方法 | |
Zhang et al. | Adaptive fault‐tolerant control for a nonlinear flexible aircraft wing system | |
KR20100071554A (ko) | 적응 미지입력 관측기를 이용한 무인항공기의 조종면 구동기 고장진단방법 | |
CN115437259A (zh) | 一种面向舵面故障的飞机姿态容错控制系统及控制方法 | |
Emami et al. | Intelligent trajectory tracking of an aircraft in the presence of internal and external disturbances | |
CN115629547B (zh) | 一种面向舵面故障的飞机机载容错控制方法及系统 | |
Péni et al. | Supervisory fault tolerant control of the GTM UAV using LPV methods | |
CN117589190B (zh) | 基于惯导/飞控的大气参数解算方法 | |
Takarics et al. | Robust control design for the FLEXOP demonstrator aircraft via tensor product models | |
CN111399473B (zh) | 一种自适应容错控制方法、系统及空中机器人 | |
Kumar et al. | Identification of helicopter dynamics using recurrent neural networks and flight data | |
CN115509136B (zh) | 一种面向线性传感器故障无人机飞行容错控制系统及方法 | |
CN110262531A (zh) | 一种基于FlexRay总线的在线模型自适应校正方法 | |
Marzat et al. | Control-based fault detection and isolation for autonomous aircraft | |
Oosterom et al. | Virtual sensor for the angle-of-attack signal in small commercial aircraft | |
CN112526884A (zh) | 一种故障系统自适应容错方法及系统 | |
CN115437359B (zh) | 一种面向传感器故障的飞机容错控制方法、系统及装置 | |
Chen et al. | Adaptive diagnosis and compensation for hypersonic flight vehicle with multisensor faults |
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 |