CN106527137A - 基于观测器的四旋翼无人机容错控制方法 - Google Patents
基于观测器的四旋翼无人机容错控制方法 Download PDFInfo
- Publication number
- CN106527137A CN106527137A CN201611062267.9A CN201611062267A CN106527137A CN 106527137 A CN106527137 A CN 106527137A CN 201611062267 A CN201611062267 A CN 201611062267A CN 106527137 A CN106527137 A CN 106527137A
- Authority
- CN
- China
- Prior art keywords
- omega
- beta
- centerdot
- matrix
- sigma
- 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
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Abstract
本发明涉及一种四旋翼无人机容错控制问题,为实现四旋翼无人机执行器故障情况下的姿态稳定。本发明采用的技术方案是,基于观测器的四旋翼无人机容错控制方法,步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析执行器对四旋翼无人机的作用原理,用未知对角矩阵表示执行器故障对其动力学特性的影响,得到四旋翼无人机执行器发生故障时的非线性动力学模型;采用基于单位四元数的姿态表示方法;采用基于浸入‑不变集方法的观测器技术对执行器进行观测。本发明主要应用于四旋翼无人机设计、控制场合。
Description
技术领域
本发明涉及一种四旋翼无人机容错控制问题。针对四旋翼无人机执行器发生失效故障时的姿态控制问题,提出一种基于浸入-不变集观测器技术的非线性自适应容错控制方法。
背景技术
四旋翼无人机依靠四个电机的转动带动螺旋桨旋转产生升力,通过改变不同电机的转速实现俯仰、滚转、偏航等动作。受飞行器控制稳定性及自身工艺影响,电机和螺旋桨的持续高速旋转使其发生故障的概率大大提高。此外,在飞行器飞行过程中会不可避免地受到外界干扰(如障碍物撞击、雨水强风、强气流等)、飞行器自身气动特性发生强烈变化等诸多不确定因素,这些都直接关系到飞行器飞行性能和安全性能。由于多旋翼飞行器是一个具有强耦合特性的典型非线性系统,一旦发生上述故障,飞行稳定性就会急剧下降,甚至导致飞行器失控,对飞行器本身及地面人员造成极大的伤害。因此,在飞行器飞行控制中加入容错控制模块以保证飞行器安全稳定的飞行显得尤为重要。如何保证多旋翼飞行器在发生故障的情况下仍能得到有效控制,正成为多旋翼飞行器研究领域的一个热点问题。
针对四旋翼无人机执行器发生故障时的姿态控制问题,目前采用较为广泛的容错控制策略大体可分为两类:被动容错和主动容错。被动容错利用控制器的鲁棒性使得控制器对故障信息不敏感,从而达到容错控制的目的;而主动容错则通过故障诊断与故障隔离能够在线检测并分离出所发生故障,再根据故障模式进行故障重构,以此达到容错控制目的。
对于上述两种容错控制策略,国内外很多研究单位,如麻省理工学院、瑞士联邦理工大学、康考迪亚大学、南京航空航天大学、北京航空航天大学等,基于多种线性或非线性控制方法开展了相关研究,如变增益PID、反步法、滑模控制、模型参考自适应、模型预测控制等方法,并且对这些方法的控制效果具有数值仿真或实际飞行实验的验证(书籍:Automatic Flight Control Systems-Latest Development;著者:Youmin Zhang,AnnasChamseddine;出版年月:2012年;文章题目:Fault Tolerant and Flight ControlTechniques with application to a Quadrotor UAV Testbed;页码:119–150)。
但是,当前各种容错控制方法均有其各自的局限性。比如:在对执行器故障进行动力学建模时,将其视为外部扰动力矩,进行了较大程度的近似,难以反映执行器故障对无人机的真实影响(期刊:控制理论与应用;著者:杨荟憭,姜斌,张柯;出版年月:2014年;文章题目:四旋翼直升机姿态系统的直接自我修复控制;页码:1053-1060);部分容错控制方法在平衡点处对四旋翼无人机的动力学模型进行了线性化处理,理论证明只能得到平衡点附近的稳定结论,当执行器发生故障时,飞行器姿态会发生突变,且多数情况下飞行器姿态会偏离平衡点较大位置,控制器应用范围难以保证(期刊:IEEE Transactions on ControlSystems Technology;著者:Z.T.Dydek,A.M.Annaswamy,E.Lavretsky;出版年月:2013年7月;文章题目:Adaptive Control of Quadrotor UAVs:a Design Trade Study withFlight Evaluations;页码:1400–1406);被动容错方法应用范围有限,难以做到对外界扰动和执行器故障鲁棒性的兼容性,控制效果较差,而主动容错控制方法则需要进行故障诊断和故障隔离,并在此基础上进行故障重构,算法复杂,难以实现工程应用(期刊:Proceedings of the Institution of Mechanical Engineers,Part I,Journal ofSystems and Control Engineering;著者:T.Li,Y.M.Zhang,B.W.Gordon;出版年月:2012年1月;文章题目:Passive and Active Nonlinear Fault-Tolerant Control of aQuadrotor UAV Based on Sliding Mode Control Technique;页码:12-23)。
发明内容
为克服现有技术的不足,实现四旋翼无人机执行器故障情况下的姿态稳定。本发明采用的技术方案是,基于观测器的四旋翼无人机容错控制方法,步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析执行器对四旋翼无人机的作用原理,用未知对角矩阵表示执行器故障对其动力学特性的影响,得到四旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J∈R3×3为转动惯量,S(ω)表示求取ω对应的反对称矩阵,L∈R3×4为与机身长度和反扭矩系数相关的常系数矩阵,F=diag{[f1 f2 f3 f4]T}∈R4×4表示升力矩阵,f1,f2,f3,f4分别表示四个电机产生的升力,diag{[f1 f2 f3 f4]T}表示向量[f1 f2f3 f4]张成的对角矩阵,λ=[λ1 λ2 λ3 λ4]T∈R4×1表示故障向量,λi=1,i=1,2,3,4表示第i个通道执行器正常,λi≠1,i=1,2,3,4表示第i个通道执行器发生故障,假设执行器故障为常增益型故障,因此故障向量λ满足:
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中 且满足k∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{B}绕矢量k旋转的任意角度;由机体坐标系{B}到惯性坐标系{I}的坐标变换矩阵用四元数表示为I3为3×3的单位矩阵,下同,S(qv)表示求取qv对应的反对称矩阵,同理,目标坐标系{Bd}在惯性坐标系{I}下的表达也可以用“等效轴角坐标系”方法,将{Bd}和{I}重合,将{Bd}绕矢量kd∈R3×1按右手定则旋转角,得到目标姿态单位四元数其中且满足kd∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{Bd}绕矢量kd旋转的任意角度;由目标坐标系{Bd}到惯性坐标系{I}的坐标变换矩阵用四元数表示为S(qvd)表示求取qvd对应的反对称矩阵,为了描述四旋翼无人机当前姿态与目标姿态之间的差异,定义姿态误差四元数
其中e0和ev同样满足由目标坐标系{Bd}到机体坐标系{B}的坐标变换矩阵示为S(ev)表示求取ev对应的反对称矩阵;
为了对四旋翼无人机执行器故障进行更有针对性的容错控制,采用基于浸入-不变集方法的观测器技术对执行器进行观测,定义观测器为:
其中ξ∈R4为观测器状态,表示求取ξ的一阶时间导数,R3×R3×R3×R3×R4→R4为待求函数,为方便表示,用X代替ωd,eq,表示求取对ω的偏导数,表示求取对的偏导数,表示求取对X的偏导数,J-1表示J的逆矩阵,表示求取的一阶时间导数,表示求取X的一阶时间导数,表示对λ的估计向量,表示对ω的估计值,且满足:
其中为正增益函数,定义故障观测误差为z∈R4:
其中r∈R为动态增益,对z求一阶时间导数,得
假设存在正常数γ和连续可微矩阵:利用分别表示的列向量,使得
定义其中W1,W2,W3分别为:
其中表示相对于σ从0到ω1的定积分,下同,式(8)中分别为:
其中表示在ω1=σ,时的取值,对W1求ω1的偏导数,整理得
其中表示求取对ω1的偏导数,同理可得, 因此写为:
定义ω的估计误差为:由于连续可微,因此存在δij∈R4,i,j=1,2,3满足:
因此写为:
其中表示求取eω1Δ1+eω2Δ2+eω3Δ3的和,Δj=[δ1j δ2j δ3j]∈R4×3,δjj=0,j=1,2,3,将式(15)代入式(7),整理得
对eω求一阶时间导数,整理得
设计r,分别满足:
其中,r(0)表示r的初值,c,m,p均为正常数,且满足c≥3/(2γ),表示Δj的上界,||·||表示2范数,I3为3×3的单位矩阵,为3×3的对角矩阵,若式(16)和式(17)成立,则由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z,r,eω均有界。
由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z(t),r(t),eω(t)均有界的证明步骤是采用基于Lyapunov的分析方法进行证明,具体地:
定义滑模面其中Ks为一3×3的正常数增益对角矩阵,证明当s渐近收敛到0时,和ev也渐近收敛到0的过程是:
对s求导,并将代入得
其中:
rLFz是有界的,因此假设||-rLFz||≤ρ,ρ为正常数,设计控制输入F为
其中LR=LT(LLT)-1表示矩阵L的伪逆矩阵,Γ为一3×3的正常数增益对角矩阵,sign为符号函数,将式(19)代入式(18),采用基于Lyapunov的分析方法可以证明闭环系统全局渐近稳定,即当时间趋于无穷时,滑模面s渐近收敛到0,则和ev也渐近收敛到0。
本发明的特点及有益效果是:
本发明采用基于观测器技术的方法针对四旋翼无人机执行器故障的容错控制进行研究。该方法既能对故障信息进行有效估计,进行很好的抑制,又不需要主动容错控制所需要的故障隔离,大大地减少了计算量,提高的控制效率。实验表明,该方法对四旋翼无人机执行器故障具有较好的鲁棒性,当四旋翼无人机执行器发生故障时,无人机能够迅速克服故障影响,保持姿态稳定。
附图说明:
图1是本发明所用实验平台。
图2是容错控制实验效果图,图中:
a是欧拉角形式的姿态角变化曲线;
b是姿态误差四元数变化曲线;
c是角速度误差变化曲线;
d是控制输入变化曲线;
e是电机转速变化曲线;
f是角速度估计误差变化曲线;
g是故障估计变化曲线;
h是故障估计误差变化曲线。
具体实施方式
可实现四旋翼无人机执行器发生故障时的姿态控制,包括下列步骤:
为了进行四旋翼无人机动力学和运动学特性分析,首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd}。通过分析执行器对四旋翼无人机的作用原理,用未知对角矩阵表示执行器故障对其动力学特性的影响,得到四旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J∈R3×3为转动惯量,S(ω)表示求取ω对应的反对称矩阵,L∈R3×4为与机身长度和反扭矩系数相关的常系数矩阵,F=diag{[f1 f2 f3 f4]T}∈R4×4表示升力矩阵,f1,f2,f3,f4分别表示四个电机产生的升力,diag{[f1 f2 f3 f4]T}表示向量[f1 f2f3 f4]张成的对角矩阵,λ=[λ1 λ2 λ3 λ4]T∈R4×1表示故障向量,λi=1,i=1,2,3,4表示第i个通道执行器正常,λi≠1,i=1,2,3,4表示第i个通道执行器发生故障,假设执行器故障为常增益型故障,因此故障向量λ满足:
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中 且满足k∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{B}绕矢量k旋转的任意角度;由机体坐标系{B}到惯性坐标系{I}的坐标变换矩阵用四元数表示为I3为3×3的单位矩阵,下同,S(qv)表示求取qv对应的反对称矩阵,同理,目标坐标系{Bd}在惯性坐标系{I}下的表达也可以用“等效轴角坐标系”方法,将{Bd}和{I}重合,将{Bd}绕矢量kd∈R3×1按右手定则旋转角,得到目标姿态单位四元数其中且满足kd∈R3×1同样为定义在坐标系{I}中的任意单位矢量,为坐标系{Bd}绕矢量kd旋转的任意角度;由目标坐标系{Bd}到惯性坐标系{I}的坐标变换矩阵用四元数表示为S(qvd)表示求取qvd对应的反对称矩阵。为了描述四旋翼无人机当前姿态与目标姿态之间的差异,定义姿态误差四元数
其中e0和ev同样满足由目标坐标系{Bd}到机体坐标系{B}的坐标变换矩阵可表示为S(ev)表示求取ev对应的反对称矩阵。
为了对四旋翼无人机执行器故障进行更有针对性的容错控制,采用基于浸入-不变集方法的观测器技术对执行器进行观测,定义观测器为:
其中ξ∈R4为观测器状态,表示求取ξ的一阶时间导数,R3×R3×R3×R3×R4→R4为待求函数,为方便表示,用X代替ωd,eq。表示求取对ω的偏导数,表示求取对的偏导数,表示求取对X的偏导数,J-1表示J的逆矩阵,表示求取的一阶时间导数,表示求取X的一阶时间导数,表示对λ的估计向量,表示对ω的估计值,且满足:
其中为正增益函数,定义故障观测误差为z∈R4:
其中r∈R为动态增益。对z求一阶时间导数,得
假设存在正常数γ和连续可微矩阵:利用分别表示的列向量,使得
定义其中W1,W2,W3分别为:
其中表示相对于σ从0到ω1的定积分,下同。式(8)中分别为:
其中表示在ω1=σ,时的取值,下同。对W1求ω1的偏导数,整理得
其中表示求取对ω1的偏导数,下同。同理可得, 因此写为:
定义ω的估计误差为:由于连续可微,因此存在δij∈R4,i,j=1,2,3满足:
因此写为:
其中表示求取eω1Δ1+eω2Δ2+eω3Δ3的和,Δj=[δ1j δ2 jδ3j]∈R4×3,δjj=0,j=1,2,3,将式(15)代入式(7),整理得
对eω求一阶时间导数,整理得
设计r,分别满足:
其中,r(0)表示r的初值,c,m,p均为正常数,且满足c≥3/(2γ),表示Δj的上界,||·||表示2范数,I3为3×3的单位矩阵,为3×3的对角矩阵,若式(16)和式(17)成立,则由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z,r,eω均有界。该结论可采用基于Lyapunov的分析方法进行证明。
定义滑模面其中Ks为一3×3的常数增益对角矩阵。可以证明,当s渐近收敛到0时,和ev也渐近收敛到0。
对s求导,并将代入可得
其中可以证明rLFz是有界的,因此假设||-rLFz||≤ρ,ρ为正常数。设计控制输入F为
其中LR=LT(LLT)-1表示矩阵L的伪逆矩阵,Γ为一3×3的常数增益对角矩阵,sign为符号函数。将式(19)代入式(18),采用基于Lyapunov的分析方法可以证明闭环系统全局渐近稳定,即当时间趋于无穷时,滑模面s渐近收敛到0,则和ev也渐近收敛到0。
为验证本发明所设计容错控制方法的有效性,利用课题组自主研发的四旋翼无人机平台进行了实验验证。下面结合实验和附图对本发明针对四旋翼无人机执行器故障的容错控制方法作出详细说明。
本发明针对四旋翼无人机执行器发生故障时的姿态控制问题,基于浸入-不变集方法设计了观测器对执行器故障进行观测,然后根据观测结果设计了滑模控制器对故障进行补偿,实现了四旋翼无人机执行器故障情况下的姿态稳定。
一、实验平台简介
实验平台如图1所示。该实验平台采用PC/104嵌入式计算机作为仿真控制器,基于Matlab RTW工具箱的xPC目标作为实时仿真环境,采用自主设计的惯性测量单元作为姿态传感器,俯仰角、滚转角测量精度为±0.2°。偏航角测量精度为±0.5°。整个系统控制频率为500Hz。
二、容错控制实验
本发明所采用方法中涉及的各参数取值如下:J=diag{[1.25 1.25 2.5]T}kg·m2,l=0.225m,ε=0.25,c=2.5,γ=1,p=1,m=50,Ks=diag{[2. 22.5 4]T},ρ=0.40,Γ=diag{[1.86 1.86 3.05]T}。初始姿态角和角速度分别为qd=[1 0 0 0]T,ωd=[0 0 0]Trad/s。保持上述各参数不变,令故障矩阵为:
即在前80s(‘s’为秒,下同),四旋翼无人机四个电机正常运行。在第80s时,第3个电机只能提供正常升力的90%。在第125s时,第2个电机只能提供正常升力的80%。实验结果分别如图2(a)、图2(b)、图2(c)、图2(d)、图2(e)、图2(f)、图2(g)、图2(h)所示。图2(a)和图2(b)表示姿态变化曲线,分别用欧拉角和四元数表示,在第80s,第三个电机发生故障,滚转角和俯仰角发生8°左右的波动而偏航角为3°。在第125s,第二个电机发生了更为剧烈的故障,此时滚转角变化约为12°,俯仰角为20°,偏航角为4°。故障发生后,姿态误差均在5s之内迅速收敛到0。图2(c)为角速度误差的变化曲线,故障发生后,其在2s之内迅速收敛到0。图2(d)和图2(e)分别表示控制输入曲线变化和电机转速变化曲线,均在合理变化范围内。图2(f)表示角速度估计误差曲线,故障发生后迅速收敛到0。图2(g)和图2(h)分别表示对故障的估计值和估计误差的变化曲线,均为稳定状态,与理论计算结果相符。
经过上述分析,证明了本发明所提算法的有效性。
Claims (2)
1.一种基于观测器的四旋翼无人机容错控制方法,其特征是,步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析执行器对四旋翼无人机的作用原理,用未知对角矩阵表示执行器故障对其动力学特性的影响,得到四旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J∈R3×3为转动惯量,S(ω)表示求取ω对应的反对称矩阵,L∈R3×4为与机身长度和反扭矩系数相关的常系数矩阵,F=diag{[f1 f2 f3 f4]T}∈R4×4表示升力矩阵,f1,f2,f3,f4分别表示四个电机产生的升力,diag{[f1 f2 f3 f4]T}表示向量[f1 f2 f3f4]张成的对角矩阵,λ=[λ1 λ2 λ3 λ4]T∈R4×1表示故障向量,λi=1,i=1,2,3,4表示第i个通道执行器正常,λi≠1,i=1,2,3,4表示第i个通道执行器发生故障,假设执行器故障为常增益型故障,因此故障向量λ满足:
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中且满足k∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{B}绕矢量k旋转的任意角度;由机体坐标系{B}到惯性坐标系{I}的坐标变换矩阵用四元数表示为I3为3×3的单位矩阵,下同,S(qv)表示求取qv对应的反对称矩阵,同理,目标坐标系{Bd}在惯性坐标系{I}下的表达也可以用“等效轴角坐标系”方法,将{Bd}和{I}重合,将{Bd}绕矢量kd∈R3×1按右手定则旋转角,得到目标姿态单位四元数其中且满足kd∈R3×1为定义在坐标系{I}中的任意单位矢量,为坐标系{Bd}绕矢量kd旋转的任意角度;由目标坐标系{Bd}到惯性坐标系{I}的坐标变换矩阵用四元数表示为S(qvd)表示求取qvd对应的反对称矩阵,为了描述四旋翼无人机当前姿态与目标姿态之间的差异,定义姿态误差四元数
其中e0和ev同样满足由目标坐标系{Bd}到机体坐标系{B}的坐标变换矩阵示为S(ev)表示求取ev对应的反对称矩阵;
为了对四旋翼无人机执行器故障进行更有针对性的容错控制,采用基于浸入-不变集方法的观测器技术对执行器进行观测,定义观测器为:
其中ξ∈R4为观测器状态,表示求取ξ的一阶时间导数, 为待求函数,为方便表示,用X代替ωd,eq,表示求取对ω的偏导数,表示求取对的偏导数,表示求取对X的偏导数,J-1表示J的逆矩阵,表示求取的一阶时间导数,表示求取X的一阶时间导数,表示对λ的估计向量,表示对ω的估计值,且满足:
其中为正增益函数,定义故障观测误差为z∈R4:
其中r∈R为动态增益,对z求一阶时间导数,得
假设存在正常数γ和连续可微矩阵:利用分别表示的列向量,使得:
定义其中W1,W2,W3分别为:
其中表示相对于σ从0到ω1的定积分,下同,式(8)中分别为:
其中表示在ω1=σ,时的取值,对W1求ω1的偏导数,整理得
其中表示求取对ω1的偏导数,同理可得, 因此写为:
定义ω的估计误差为:由于连续可微,因此存在δij∈R4,i,j=1,2,3满足:
因此写为:
其中表示求取eω1Δ1+eω2Δ2+eω3Δ3的和,Δj=[δ1j δ2j δ3j]∈R4×3,δjj=0,j=1,2,3,将式(15)代入式(7),整理得
对eω求一阶时间导数,整理得
设计r,分别满足:
其中,r(0)表示r的初值,c,m,p均为正常数,且满足c≥3/(2γ),表示Δj的上界,||·||表示2范数,I3为3×3的单位矩阵,为3×3的对角矩阵,若式(16)和式(17)成立,则由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z,r,eω均有界。
2.如权利要求1所述的基于观测器的四旋翼无人机容错控制方法,其特征是,由式(16)和式(17)组成的系统有一个全局稳定的平衡点(z,eω)=(0,0),且z(t),r(t),eω(t)均有界的证明步骤是采用基于Lyapunov的分析方法进行证明,具体地:
定义滑模面其中Ks为一3×3的正常数增益对角矩阵,证明当s渐近收敛到0时,和ev也渐近收敛到0的过程是:
对s求导,并将代入得
其中:
rLFz是有界的,因此假设||-rLFz||≤ρ,ρ为正常数,设计控制输入F为
其中LR=LT(LLT)-1表示矩阵L的伪逆矩阵,Γ为一3×3的正常数增益对角矩阵,sign为符号函数,将式(19)代入式(18),采用基于Lyapunov的分析方法可以证明闭环系统全局渐近稳定,即当时间趋于无穷时,滑模面s渐近收敛到0,则和ev也渐近收敛到0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611062267.9A CN106527137B (zh) | 2016-11-25 | 2016-11-25 | 基于观测器的四旋翼无人机容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611062267.9A CN106527137B (zh) | 2016-11-25 | 2016-11-25 | 基于观测器的四旋翼无人机容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106527137A true CN106527137A (zh) | 2017-03-22 |
CN106527137B CN106527137B (zh) | 2019-08-16 |
Family
ID=58357520
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611062267.9A Active CN106527137B (zh) | 2016-11-25 | 2016-11-25 | 基于观测器的四旋翼无人机容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106527137B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107256028A (zh) * | 2017-07-24 | 2017-10-17 | 大连理工大学 | 四旋翼飞行器对角动力损失状态下的失控保护控制算法 |
CN107992084A (zh) * | 2017-12-27 | 2018-05-04 | 北京航空航天大学 | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 |
CN109032156A (zh) * | 2018-07-03 | 2018-12-18 | 北京航空航天大学 | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
CN109445448A (zh) * | 2018-10-31 | 2019-03-08 | 中国人民解放军战略支援部队航天工程大学 | 一种轮控小卫星自适应积分滑模姿态控制器 |
CN109491244A (zh) * | 2017-09-13 | 2019-03-19 | 南京航空航天大学 | 一种基于滑模观测器的无人机编队系统故障诊断方法 |
CN109856972A (zh) * | 2019-02-21 | 2019-06-07 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪控制方法 |
CN109947126A (zh) * | 2019-03-07 | 2019-06-28 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
CN111459188A (zh) * | 2020-04-29 | 2020-07-28 | 南京理工大学 | 一种基于四元数的多旋翼非线性飞行控制方法 |
US20200326672A1 (en) * | 2019-01-10 | 2020-10-15 | Dalian University Of Technology | Interval error observer-based aircraft engine active fault tolerant control method |
CN111880410A (zh) * | 2020-08-11 | 2020-11-03 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN112327896A (zh) * | 2020-10-29 | 2021-02-05 | 东北大学 | 旋翼容错控制方法、装置、计算机存储介质及计算机设备 |
CN112445231A (zh) * | 2019-08-30 | 2021-03-05 | 中移(苏州)软件技术有限公司 | 一种姿态控制方法、多旋翼飞行器及可读存储介质 |
CN113778115A (zh) * | 2021-08-30 | 2021-12-10 | 北京三快在线科技有限公司 | 多旋翼无人机的控制方法、装置、介质、设备及无人机 |
CN113791544A (zh) * | 2021-11-15 | 2021-12-14 | 滨州学院 | 多旋翼无人机的控制方法、系统、装置及电子设备 |
CN114995483A (zh) * | 2022-06-28 | 2022-09-02 | 四川大学 | 基于对偶四元数的倾转旋翼多旋翼无人机跟踪控制方法 |
WO2022193075A1 (zh) * | 2021-03-15 | 2022-09-22 | 深圳市大疆创新科技有限公司 | 无人飞行器控制方法、无人飞行器和存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20100071554A (ko) * | 2008-12-19 | 2010-06-29 | 주식회사 대한항공 | 적응 미지입력 관측기를 이용한 무인항공기의 조종면 구동기 고장진단방법 |
CN104102132A (zh) * | 2014-06-27 | 2014-10-15 | 金陵科技学院 | 基于非仿射非线性无人飞行器鲁棒自适应容错控制方法 |
US9102406B2 (en) * | 2013-02-15 | 2015-08-11 | Disney Enterprises, Inc. | Controlling unmanned aerial vehicles as a flock to synchronize flight in aerial displays |
CN104965414A (zh) * | 2015-06-30 | 2015-10-07 | 天津大学 | 针对四旋翼无人机执行器部分失效的容错控制方法 |
CN105242544A (zh) * | 2015-10-30 | 2016-01-13 | 山东科技大学 | 考虑随机扰动的非线性多无人机系统容错编队控制方法 |
CN105549610A (zh) * | 2014-10-30 | 2016-05-04 | 张学一 | 一种无人机控制系统 |
US9360321B2 (en) * | 2014-04-14 | 2016-06-07 | Vricon Systems Aktiebolag | Navigation based on at least one sensor and a three dimensional map |
-
2016
- 2016-11-25 CN CN201611062267.9A patent/CN106527137B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20100071554A (ko) * | 2008-12-19 | 2010-06-29 | 주식회사 대한항공 | 적응 미지입력 관측기를 이용한 무인항공기의 조종면 구동기 고장진단방법 |
US9102406B2 (en) * | 2013-02-15 | 2015-08-11 | Disney Enterprises, Inc. | Controlling unmanned aerial vehicles as a flock to synchronize flight in aerial displays |
US9360321B2 (en) * | 2014-04-14 | 2016-06-07 | Vricon Systems Aktiebolag | Navigation based on at least one sensor and a three dimensional map |
CN104102132A (zh) * | 2014-06-27 | 2014-10-15 | 金陵科技学院 | 基于非仿射非线性无人飞行器鲁棒自适应容错控制方法 |
CN105549610A (zh) * | 2014-10-30 | 2016-05-04 | 张学一 | 一种无人机控制系统 |
CN104965414A (zh) * | 2015-06-30 | 2015-10-07 | 天津大学 | 针对四旋翼无人机执行器部分失效的容错控制方法 |
CN105242544A (zh) * | 2015-10-30 | 2016-01-13 | 山东科技大学 | 考虑随机扰动的非线性多无人机系统容错编队控制方法 |
Non-Patent Citations (4)
Title |
---|
TAMAS PENI等: "SUPERVISORY FAULT TOLERANT CONTROL OF THE GTM UAV USING LPV METHODS", 《INTERNATIONAL JOURNAL OF APPLIED MATHEMATICS AND COMPUTER SCIENCE》 * |
ZHAOHUI CEN等: "SYSTEMATIC FAULT TOLERANT CONTROL BASED ON ADAPTIVE THAU OBSERVER ESTIMATION FOR QUADROTOR UAVS", 《INTERNATIONAL JOURNAL OF APPLIED MATHEMATICS AND COMPUTER SCIENCE》 * |
宫勋等: "基于双观测器并行结构的四旋翼无人机故障检测与重构", 《控制与决策》 * |
郝伟等: "四旋翼无人机姿态系统的非线性容错控制设计", 《控制理论与应用》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107256028A (zh) * | 2017-07-24 | 2017-10-17 | 大连理工大学 | 四旋翼飞行器对角动力损失状态下的失控保护控制算法 |
CN107256028B (zh) * | 2017-07-24 | 2020-05-12 | 大连理工大学 | 四旋翼飞行器对角动力损失状态下的失控保护控制算法 |
CN109491244A (zh) * | 2017-09-13 | 2019-03-19 | 南京航空航天大学 | 一种基于滑模观测器的无人机编队系统故障诊断方法 |
CN107992084A (zh) * | 2017-12-27 | 2018-05-04 | 北京航空航天大学 | 不依靠角速度反馈的无人机鲁棒姿态控制方法和装置 |
CN109032156A (zh) * | 2018-07-03 | 2018-12-18 | 北京航空航天大学 | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 |
CN109032156B (zh) * | 2018-07-03 | 2020-08-25 | 北京航空航天大学 | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 |
CN109445448A (zh) * | 2018-10-31 | 2019-03-08 | 中国人民解放军战略支援部队航天工程大学 | 一种轮控小卫星自适应积分滑模姿态控制器 |
CN109445448B (zh) * | 2018-10-31 | 2021-08-17 | 中国人民解放军战略支援部队航天工程大学 | 一种轮控小卫星自适应积分滑模姿态控制器 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
CN109343369B (zh) * | 2018-11-19 | 2021-08-10 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
US20200326672A1 (en) * | 2019-01-10 | 2020-10-15 | Dalian University Of Technology | Interval error observer-based aircraft engine active fault tolerant control method |
US11635734B2 (en) * | 2019-01-10 | 2023-04-25 | Dalian University Of Technology | Interval error observer-based aircraft engine active fault tolerant control method |
CN109856972A (zh) * | 2019-02-21 | 2019-06-07 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪控制方法 |
CN109947126B (zh) * | 2019-03-07 | 2020-04-14 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
CN109947126A (zh) * | 2019-03-07 | 2019-06-28 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
CN112445231A (zh) * | 2019-08-30 | 2021-03-05 | 中移(苏州)软件技术有限公司 | 一种姿态控制方法、多旋翼飞行器及可读存储介质 |
CN111459188A (zh) * | 2020-04-29 | 2020-07-28 | 南京理工大学 | 一种基于四元数的多旋翼非线性飞行控制方法 |
CN111459188B (zh) * | 2020-04-29 | 2022-07-19 | 南京理工大学 | 一种基于四元数的多旋翼非线性飞行控制方法 |
CN111880410A (zh) * | 2020-08-11 | 2020-11-03 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN111880410B (zh) * | 2020-08-11 | 2021-12-28 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN112327896A (zh) * | 2020-10-29 | 2021-02-05 | 东北大学 | 旋翼容错控制方法、装置、计算机存储介质及计算机设备 |
WO2022193075A1 (zh) * | 2021-03-15 | 2022-09-22 | 深圳市大疆创新科技有限公司 | 无人飞行器控制方法、无人飞行器和存储介质 |
CN113778115A (zh) * | 2021-08-30 | 2021-12-10 | 北京三快在线科技有限公司 | 多旋翼无人机的控制方法、装置、介质、设备及无人机 |
CN113791544A (zh) * | 2021-11-15 | 2021-12-14 | 滨州学院 | 多旋翼无人机的控制方法、系统、装置及电子设备 |
CN114995483A (zh) * | 2022-06-28 | 2022-09-02 | 四川大学 | 基于对偶四元数的倾转旋翼多旋翼无人机跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106527137B (zh) | 2019-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106527137B (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN104965414B (zh) | 针对四旋翼无人机执行器部分失效的容错控制方法 | |
CN109343369B (zh) | 一种基于非线性观测器的四旋翼容错控制器设计方法 | |
Hou et al. | Nonsingular terminal sliding mode control for a quadrotor UAV with a total rotor failure | |
Lu et al. | Aircraft fault-tolerant trajectory control using incremental nonlinear dynamic inversion | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
Tang et al. | An integral TSMC-based adaptive fault-tolerant control for quadrotor with external disturbances and parametric uncertainties | |
CN106842952A (zh) | 针对三旋翼无人机舵机堵塞故障的容错控制方法 | |
CN108445760A (zh) | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 | |
Lu et al. | Real-time simulation system for UAV based on Matlab/Simulink | |
CN103105850A (zh) | 一种近空间飞行器故障诊断与容错控制方法 | |
CN104950901A (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
Li et al. | Reference output tracking control for a flexible air‐breathing hypersonic vehicle via output feedback | |
CN111258302B (zh) | 一种基于lstm神经网络的飞行器推力故障在线辨识方法 | |
CN110058600A (zh) | 三旋翼无人机舵机堵塞故障下位姿系统的容错控制方法 | |
CN111880410A (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
Lendek et al. | Application of Takagi-Sugeno observers for state estimation in a quadrotor | |
CN113485304A (zh) | 一种基于深度学习故障诊断的飞行器分层容错控制方法 | |
Hamadi et al. | Observer-based super twisting controller robust to wind perturbation for multirotor uav | |
CN114721266B (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
Wang et al. | Hybrid modeling based double-granularity fault detection and diagnosis for quadrotor helicopter | |
CN113625730B (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
Jing et al. | Adaptive sliding mode backstepping control for near space vehicles considering engine faults | |
Okada et al. | Neuroadaptive Observer-Based Fault-Diagnosis and Fault-Tolerant Control for Quadrotor UAV | |
Bakırcıoğlu et al. | Experimental comparison of the effect of the number of redundant rotors on the fault tolerance performance for the proposed multilayer UAV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |