CN106842952A - 针对三旋翼无人机舵机堵塞故障的容错控制方法 - Google Patents
针对三旋翼无人机舵机堵塞故障的容错控制方法 Download PDFInfo
- Publication number
- CN106842952A CN106842952A CN201710135783.8A CN201710135783A CN106842952A CN 106842952 A CN106842952 A CN 106842952A CN 201710135783 A CN201710135783 A CN 201710135783A CN 106842952 A CN106842952 A CN 106842952A
- Authority
- CN
- China
- Prior art keywords
- matrix
- omega
- represent
- unmanned aerial
- rotor wing
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000013461 design Methods 0.000 claims abstract description 12
- 238000005516 engineering process Methods 0.000 claims abstract description 10
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 79
- 230000009466 transformation Effects 0.000 claims description 9
- 101100042610 Arabidopsis thaliana SIGB gene Proteins 0.000 claims description 8
- 238000004458 analytical method Methods 0.000 claims description 7
- 230000003044 adaptive effect Effects 0.000 claims description 5
- 101100421503 Arabidopsis thaliana SIGA gene Proteins 0.000 claims description 4
- 101100294408 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) MOT2 gene Proteins 0.000 claims description 4
- 101150117326 sigA gene Proteins 0.000 claims description 4
- 230000017105 transposition Effects 0.000 claims description 4
- 238000012795 verification Methods 0.000 claims description 2
- 230000000903 blocking effect Effects 0.000 claims 1
- 238000011160 research Methods 0.000 abstract description 9
- 230000009471 action Effects 0.000 abstract description 5
- 230000008859 change Effects 0.000 description 11
- 238000002474 experimental method Methods 0.000 description 8
- 230000000694 effects Effects 0.000 description 5
- 230000006978 adaptation Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 230000005611 electricity Effects 0.000 description 2
- 238000002955 isolation Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 241000232997 Anna Species 0.000 description 1
- 206010034719 Personality change Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011069 regeneration method Methods 0.000 description 1
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
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
本发明涉及三旋翼无人机容错控制技术,为针对三旋翼无人机发生舵机堵塞故障时的姿态控制问题开展研究,本发明采用的技术方案是,针对三旋翼无人机舵机堵塞故障的容错控制方法,步骤如下:首先定义惯性坐标系{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=diag{[J1 J2 J3]T}∈R3×3为转动惯量矩阵,diag{[J1 J2 J3]T}表示向量[J1 J2 J3]张成的对角矩阵,J1,J2,J3分别表示绕各个坐标轴的转动惯量;S(ω)表示求取ω对应的反对称矩阵;为一系数矩阵,其中l表示前面某一电机中心到无人机轴心的距离,l3表示舵机中心到无人机轴心的距离,α表示前面两个电机连线与某一电机和无人机轴心连线之间的夹角,k为电机的升力系数,δf为舵机发生堵塞时的偏转角度,l,l3,α,k均为已知常数,δf为未知常数,sin(·)和cos(·)分别表示正弦和余弦函数;fδ=[fδ1 fδ2 fδ3]T∈R3×1表示故障发生后的升力向量,fδ1,fδ2,fδ3分别表示故障发生后三个电机产生的升力,D=diag{[d1 d2 d3]T}∈R3×3为外部扰动矩阵,diag{[d1 d2 d3]T}表示向量[d1 d2 d3]张成的对角矩阵,d1,d2,d3分别表示作用于各个通道的外部扰动;
定义变量λ1=-l3cosδf,λ2=kcosδf+l3sinδf,则λ1,λ2为未知常数,A(δf)可写为式(1)可表示为
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k0∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中 且满足k0∈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对应的反对称矩阵,定义角速度误差其中ωd∈R3×1表示目标坐标系{Bd}相对于惯性坐标系{I}的姿态角速度;
为了对三旋翼无人机舵机堵塞故障进行更有针对性的容错控制,采用基于自适应滑模方法的观测器技术对故障进行观测,设计观测器为:
其中表示对ω的估计值,表示求取的一阶时间导数,v=[v1 v2 v3]T∈R3 ×1,表示求取v的一阶时间导数,定义ω的估计误差为 分别表示对λ1,λ2的估计值,SIG2=[k21sign(eω1) k22sign(eω2) k23sign(eω3)]T,SIG1=[k11|eω1|1/2sign(eω1) k12|eω2|1/2sign(eω2) k13|eω3|1/2sign(eω3)]T,其中k11,k12,k13,k21,k22,k23均为正常数,eω1,eω2,eω3为eω的三个元素,sign(·)表示符号函数,|·|1/2表示求取绝对值的次方;
定义变量z1i=|eωi|1/2sign(eωi),z2i=vi,i=1,2,3,设计控制器为:
其中表示求取矩阵的逆矩阵,表示求取ωd的一阶时间导数,G=diag{[g1 g2 g3]T}∈R3×3为正常数增益矩阵,diag{[g1 g2 g3]T}表示向量[g1 g2 g3]张成的对角矩阵,g1,g2,g3均为正常数。为外部扰动估计矩阵,表示向量张成的对角矩阵,是对d1,d2,d3的估计值;
若设计和的自适应律满足:
其中ε1,ε2,m,n,γ1,γ2,γ3均为正常数,分别表示滚转角速度误差、俯仰角速度误差和偏航角速度误差,则姿态误差四元数和角速度误差渐近稳定。
验证步骤具体是,采用基于Lyapunov的分析方法可以证明当时间趋于无穷时,和ev分别渐近收敛到[0 0 0]T。
本发明的特点及有益效果是:
本发明较早地针对三旋翼无人机发生舵机堵塞故障时的姿态控制问题采用基于观测器技术的方法进行研究。该方法既能对故障信息进行有效估计,对其进行很好地抑制,又不需要主动容错控制所需要的故障隔离,大大地减少了计算量,提高了控制效率。实验表明,该方法对三旋翼无人机舵机堵塞故障具有较好的鲁棒性,当三旋翼无人机舵机发生堵塞故障时,无人机能够较快地克服故障影响,保持姿态稳定。
附图说明:
图1是本发明所用实验平台。
图2是容错控制实验效果图,图中:
a是姿态误差四元数变化曲线;
b是角速度误差变化曲线;
c是控制输入变化曲线;
d是电机转速变化曲线;
e是角速度估计误差变化曲线;
f是舵机堵塞故障估计值变化曲线;
g是外部扰动估计值变化曲线。
具体实施方式
本发明涉及一种三旋翼无人机容错控制问题。针对三旋翼无人机舵机发生堵塞故障时的姿态控制问题,提出一种基于自适应滑模观测器技术的非线性容错控制方法。
为填补现有研究对象的空白,针对三旋翼无人机发生舵机堵塞故障时的姿态控制问题开展研究。本发明采用的技术方案是基于自适应滑模观测器的容错控制方法,利用观测器对故障信息进行观测,控制器的设计采用观测器的观测信息,对执行器故障进行补偿。
具体步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析舵机对三旋翼无人机的作用原理,并考虑外部扰动对其动力学特性的影响,得到三旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J=diag{[J1 J2 J3]T}∈R3×3为转动惯量矩阵,diag{[J1 J2 J3]T}表示向量[J1 J2 J3]张成的对角矩阵,J1,J2,J3分别表示绕各个坐标轴的转动惯量;S(ω)表示求取ω对应的反对称矩阵;为一系数矩阵,其中l表示前面某一电机中心到无人机轴心的距离,l3表示舵机中心到无人机轴心的距离,α表示前面两个电机连线与某一电机和无人机轴心连线之间的夹角,k为电机的升力系数,δf为舵机发生堵塞时的偏转角度,l,l3,α,k均为已知常数,δf为未知常数,sin(·)和cos(·)分别表示正弦和余弦函数;fδ=[fδ1 fδ2 fδ3]T∈R3×1表示故障发生后的升力向量,fδ1,fδ2,fδ3分别表示故障发生后三个电机产生的升力,D=diag{[d1 d2 d3]T}∈R3×3为外部扰动矩阵,diag{[d1 d2 d3]T}表示向量[d1 d2 d3]张成的对角矩阵,d1,d2,d3分别表示作用于各个通道的外部扰动。
为方便分析,定义变量λ1=-l3cosδf,λ2=kcosδf+l3sinδf,则λ1,λ2为未知常数,A(δf)可写为式(1)可表示为
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k0∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中 且满足k0∈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对应的反对称矩阵。定义角速度误差其中ωd∈R3×1表示目标坐标系{Bd}相对于惯性坐标系{I}的姿态角速度。
为了对三旋翼无人机舵机堵塞故障进行更有针对性的容错控制,采用基于自适应滑模方法的观测器技术对故障进行观测,设计观测器为:
其中表示对ω的估计值,表示求取的一阶时间导数,v=[v1 v2 v3]T∈R3×1,表示求取v的一阶时间导数,定义ω的估计误差为 分别表示对λ1,λ2的估计值,SIG2=[k21sign(eω1) k22sign(eω2)k23sign(eω3)]T,SIG1=[k11|eω1|1/2sign(eω1) k12|eω2|1/2sign(eω2) k13|eω3|1/2sign(eω3)]T,其中k11,k12,k13,k21,k22,k23均为正常数,eω1,eω2,eω3为eω的三个元素,sign(·)表示符号函数,|·|1/2表示求取绝对值的次方。
定义变量z1i=|eωi|1/2sign(eωi),z2i=vi,i=1,2,3,设计控制器为:
其中表示求取矩阵的逆矩阵,表示求取ωd的一阶时间导数,G=diag{[g1 g2 g3]T}∈R3×3为正常数增益矩阵,diag{[g1 g2 g3]T}表示向量[g1 g2 g3]张成的对角矩阵,g1,g2,g3均为正常数。为外部扰动估计矩阵,表示向量张成的对角矩阵,是对d1,d2,d3的估计值。
若设计和的自适应律满足:
其中ε1,ε2,m,n,γ1,γ2,γ3均为正常数,分别表示滚转角速度误差、俯仰角速度误差和偏航角速度误差,则姿态误差四元数和角速度误差渐近稳定。采用基于Lyapunov的分析方法可以证明当时间趋于无穷时,和ev分别渐近收敛到[0 0 0]T。
可实现三旋翼无人机执行器发生故障时的姿态控制,包括下列步骤:
首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析舵机对三旋翼无人机的作用原理,并考虑外部扰动对其动力学特性的影响,得到三旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数,下同;J=diag{[J1 J2 J3]T}∈R3×3为转动惯量矩阵,diag{[J1 J2 J3]T}表示向量[J1 J2 J3]张成的对角矩阵,J1,J2,J3分别表示绕各个坐标轴的转动惯量;S(ω)表示求取ω对应的反对称矩阵;为一系数矩阵,其中l表示前面某一电机中心到无人机轴心的距离,l3表示舵机中心到无人机轴心的距离,α表示前面两个电机连线与某一电机和无人机轴心连线之间的夹角,k为电机的升力系数,δf为舵机发生堵塞时的偏转角度,l,l3,α,k均为已知常数,δf为未知常数,sin(·)和cos(·)分别表示正弦和余弦函数;fδ=[fδ1 fδ2 fδ3]T∈R3×1表示故障发生后的升力向量,fδ1,fδ2,fδ3分别表示故障发生后三个电机产生的升力,D=diag{[d1 d2 d3]T}∈R3×3为外部扰动矩阵,diag{[d1 d2 d3]T}表示向量[d1 d2 d3]张成的对角矩阵,d1,d2,d3分别表示作用于各个通道的外部扰动。
为方便分析,定义变量λ1=-l3cosδf,λ2=kcosδf+l3sinδf,则λ1,λ2为未知常数,A(δf)可写为式(1)可表示为
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k0∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中 且满足k0∈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对应的反对称矩阵。定义角速度误差其中ωd∈R3×1表示目标坐标系{Bd}相对于惯性坐标系{I}的姿态角速度。
为了对三旋翼无人机舵机堵塞故障进行更有针对性的容错控制,采用基于自适应滑模方法的观测器技术对故障进行观测,设计观测器为:
其中表示对ω的估计值,表示求取的一阶时间导数,v=[v1 v2 v3]T∈R3×1,表示求取v的一阶时间导数,定义ω的估计误差为 分别表示对λ1,λ2的估计值,SIG2=[k21sign(eω1) k22sign(eω2)k23sign(eω3)]T,SIG1=[k11|eω1|1/2sign(eω1) k12|eω2|1/2sign(eω2) k13|eω3|1/2sign(eω3)]T,其中k11,k12,k13,k21,k22,k23均为正常数,eω1,eω2,eω3为eω的三个元素,sign(·)表示符号函数,|·|1/2表示求取绝对值的次方。
定义变量z1i=|eωi|1/2sign(eωi),z2i=vi,i=1,2,3,设计控制器为:
其中表示求取矩阵的逆矩阵,表示求取ωd的一阶时间导数,G=diag{[g1 g2 g3]T}∈R3×3为正常数增益矩阵,diag{[g1 g2 g3]T}表示向量[g1 g2 g3]张成的对角矩阵,g1,g2,g3均为正常数。为外部扰动估计矩阵,表示向量张成的对角矩阵,是对d1,d2,d3的估计值。
若设计和的自适应律满足:
其中ε1,ε2,m,n,γ1,γ2,γ3均为正常数,分别表示滚转角速度误差、俯仰角速度误差和偏航角速度误差,则姿态误差四元数和角速度误差渐近稳定。采用基于Lyapunov的分析方法可以证明当时间趋于无穷时,和ev分别渐近收敛到[0 0 0]T。
一、实验平台简介
实验平台如图1所示。该实验平台采用工控机作为仿真控制器,基于Matlab RTW工具箱的xPC目标作为实时仿真环境,采用自主设计的惯性测量单元作为姿态传感器,俯仰角、滚转角测量精度为±0.2°,偏航角测量精度为±0.5°,整个***控制频率为500Hz。
二、容错控制实验
本发明所采用方法中涉及的各参数取值如下:J=diag{[1 1 2]T}kg·m2,l=0.16m,l3=0.25m,α=26°,k=0.05,D=diag{[0.1 0.1 0.1]T},ε1=ε2=10,m=2,n=1,k11=k12=5,k13=4,k21=k22=8,k23=3.5,γ1=γ2=0.1,γ3=0.2。初始姿态四元数和角速度分别为qd=[1 0 0 0]T,ωd=[0 0 0]Trad/s,三旋翼无人机的舵机在第30s发生堵塞故障,舵机堵塞角约为2.5°。实验结果分别如图2(a)、图2(b)、图2(c)、图2(d)、图2(e)、图2(f)、图2(g)所示。
图2(a)表示三旋翼无人机姿态四元数变化曲线,在前30s,三旋翼无人机保持稳定飞行,姿态四元数误差小于0.05,在第30s,舵机发生堵塞故障,无人机姿态发生变化,并在5s内迅速收敛到0。图2(b)为角速度误差的变化曲线,故障发生后,其在2s之内迅速收敛到0。由此可见,控制目标得到很好的实现。图2(c)和图2(d)分别表示控制输入曲线变化和电机转速变化曲线,均在合理变化范围内。图2(e)表示角速度估计误差曲线,故障发生后迅速收敛到0。图2(f)和图2(g)分别表示对故障的估计值和对外部扰动的估计值,均为稳定状态,与理论计算结果相符。
经过上述分析,证明了本发明所提算法的有效性。
Claims (1)
1.一种针对三旋翼无人机舵机堵塞故障的容错控制方法,其特征是,步骤如下:首先定义惯性坐标系{I}、机体坐标系{B}和目标坐标系{Bd},通过分析舵机对三旋翼无人机的作用原理,并考虑外部扰动对其动力学特性的影响,得到三旋翼无人机执行器发生故障时的非线性动力学模型:
式(1)中各变量定义如下:ω=[ω1 ω2 ω3]T∈R3×1表示机体坐标系{B}相对于惯性坐标系{I}的姿态角速度,ω1,ω2,ω3分别表示滚转角速度、俯仰角速度和偏航角速度,[·]T表示矩阵的转置,∈表示集合间的“属于”关系,R3×1表示3行1列的实数向量,表示求取ω的一阶时间导数;J=diag{[J1 J2 J3]T}∈R3×3为转动惯量矩阵,diag{[J1 J2 J3]T}表示向量[J1 J2 J3]张成的对角矩阵,J1,J2,J3分别表示绕各个坐标轴的转动惯量;S(ω)表示求取ω对应的反对称矩阵;为一系数矩阵,其中l表示前面某一电机中心到无人机轴心的距离,l3表示舵机中心到无人机轴心的距离,α表示前面两个电机连线与某一电机和无人机轴心连线之间的夹角,k为电机的升力系数,δf为舵机发生堵塞时的偏转角度,l,l3,α,k均为已知常数,δf为未知常数,sin(·)和cos(·)分别表示正弦和余弦函数;fδ=[fδ1 fδ2 fδ3]T∈R3×1表示故障发生后的升力向量,fδ1,fδ2,fδ3分别表示故障发生后三个电机产生的升力,D=diag{[d1 d2 d3]T}∈R3×3为外部扰动矩阵,diag{[d1 d2 d3]T}表示向量[d1 d2 d3]张成的对角矩阵,d1,d2,d3分别表示作用于各个通道的外部扰动;
定义变量λ1=-l3 cosδf,λ2=k cosδf+l3 sinδf,则λ1,λ2为未知常数,A(δf)可写为式(1)可表示为
为避免姿态表示奇异性问题,采用基于单位四元数的姿态表示方法,机体坐标系{B}在惯性坐标系{I}下的表达用“等效轴角坐标系”方法,将{B}和{I}重合,将{B}绕矢量k0∈R3×1按右手定则旋转角,得到当前姿态单位四元数其中且满足k0∈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对应的反对称矩阵,定义角速度误差其中ωd∈R3×1表示目标坐标系{Bd}相对于惯性坐标系{I}的姿态角速度;
为了对三旋翼无人机舵机堵塞故障进行更有针对性的容错控制,采用基于自适应滑模方法的观测器技术对故障进行观测,设计观测器为:
其中表示对ω的估计值,表示求取的一阶时间导数,v=[v1 v2 v3]T∈R3×1,表示求取v的一阶时间导数,定义ω的估计误差为 分别表示对λ1,λ2的估计值,SIG2=[k21sign(eω1) k22sign(eω2) k23sign(eω3)]T,SIG1=[k11|eω1|1/2 sign(eω1) k12|eω2|1/2 sign(eω2) k13|eω3|1/2 sign(eω3)]T,其中k11,k12,k13,k21,k22,k23均为正常数,eω1,eω2,eω3为eω的三个元素,sign(·)表示符号函数,|·|1/2表示求取绝对值的次方;
定义变量z1i=|eωi|1/2 sign(eωi),z2i=vi,i=1,2,3,设计控制器为:
其中表示求取矩阵的逆矩阵,表示求取ωd的一阶时间导数,G=diag{[g1 g2 g3]T}∈R3×3为正常数增益矩阵,diag{[g1 g2 g3]T}表示向量[g1 g2 g3]张成的对角矩阵,g1,g2,g3均为正常数。为外部扰动估计矩阵,表示向量张成的对角矩阵,是对d1,d2,d3的估计值;
若设计和的自适应律满足:
其中ε1,ε2,m,n,γ1,γ2,γ3均为正常数,分别表示滚转角速度误差、俯仰角速度误差和偏航角速度误差,则姿态误差四元数和角速度误差渐近稳定。
验证步骤具体是,采用基于Lyapunov的分析方法可以证明当时间趋于无穷时,和ev分别渐近收敛到[0 0 0]T。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710135783.8A CN106842952B (zh) | 2017-03-08 | 2017-03-08 | 针对三旋翼无人机舵机堵塞故障的容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710135783.8A CN106842952B (zh) | 2017-03-08 | 2017-03-08 | 针对三旋翼无人机舵机堵塞故障的容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106842952A true CN106842952A (zh) | 2017-06-13 |
CN106842952B CN106842952B (zh) | 2020-03-06 |
Family
ID=59144891
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710135783.8A Expired - Fee Related CN106842952B (zh) | 2017-03-08 | 2017-03-08 | 针对三旋翼无人机舵机堵塞故障的容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106842952B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108170155A (zh) * | 2018-01-14 | 2018-06-15 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN108287563A (zh) * | 2017-11-29 | 2018-07-17 | 深圳市科卫泰实业发展有限公司 | 一种多旋翼飞行器断桨保护方法及*** |
CN108333949A (zh) * | 2018-03-09 | 2018-07-27 | 南京航空航天大学 | 针对多智能体***执行器部分失效故障的滑模容错控制方法 |
CN109116860A (zh) * | 2018-08-29 | 2019-01-01 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
CN109814382A (zh) * | 2019-01-14 | 2019-05-28 | 南京航空航天大学 | 一种非最小相位飞行器控制***执行器持续间歇性故障的自适应补偿控制方法 |
CN110058600A (zh) * | 2019-02-26 | 2019-07-26 | 天津大学 | 三旋翼无人机舵机堵塞故障下位姿***的容错控制方法 |
CN110824925A (zh) * | 2019-11-29 | 2020-02-21 | 天津大学 | 倾转式三旋翼无人机的自适应鲁棒容错控制方法 |
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 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN113791544A (zh) * | 2021-11-15 | 2021-12-14 | 滨州学院 | 多旋翼无人机的控制方法、***、装置及电子设备 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100332052A1 (en) * | 2008-11-10 | 2010-12-30 | Ryan Todd Ratliff | Fault tolerant flight control system |
CN104238357A (zh) * | 2014-08-21 | 2014-12-24 | 南京航空航天大学 | 一种近空间飞行器的容错滑模控制方法 |
CN104965414A (zh) * | 2015-06-30 | 2015-10-07 | 天津大学 | 针对四旋翼无人机执行器部分失效的容错控制方法 |
-
2017
- 2017-03-08 CN CN201710135783.8A patent/CN106842952B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100332052A1 (en) * | 2008-11-10 | 2010-12-30 | Ryan Todd Ratliff | Fault tolerant flight control system |
CN104238357A (zh) * | 2014-08-21 | 2014-12-24 | 南京航空航天大学 | 一种近空间飞行器的容错滑模控制方法 |
CN104965414A (zh) * | 2015-06-30 | 2015-10-07 | 天津大学 | 针对四旋翼无人机执行器部分失效的容错控制方法 |
Non-Patent Citations (1)
Title |
---|
郝伟,鲜斌: "四旋翼无人机姿态***的非线性容错控制设计", 《控制理论与应用》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108287563A (zh) * | 2017-11-29 | 2018-07-17 | 深圳市科卫泰实业发展有限公司 | 一种多旋翼飞行器断桨保护方法及*** |
CN108170155B (zh) * | 2018-01-14 | 2021-04-06 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN108170155A (zh) * | 2018-01-14 | 2018-06-15 | 山东科技大学 | 一种三自由度直升机的被动容错控制方法 |
CN108333949A (zh) * | 2018-03-09 | 2018-07-27 | 南京航空航天大学 | 针对多智能体***执行器部分失效故障的滑模容错控制方法 |
CN108333949B (zh) * | 2018-03-09 | 2020-10-02 | 南京航空航天大学 | 针对多智能体***执行器失效故障的滑模容错控制方法 |
CN109116860A (zh) * | 2018-08-29 | 2019-01-01 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
CN109116860B (zh) * | 2018-08-29 | 2022-05-03 | 天津大学 | 三旋翼无人机的非线性鲁棒控制方法 |
US11635734B2 (en) * | 2019-01-10 | 2023-04-25 | Dalian University Of Technology | Interval error observer-based aircraft engine active fault tolerant control method |
US20200326672A1 (en) * | 2019-01-10 | 2020-10-15 | Dalian University Of Technology | Interval error observer-based aircraft engine active fault tolerant control method |
CN109814382A (zh) * | 2019-01-14 | 2019-05-28 | 南京航空航天大学 | 一种非最小相位飞行器控制***执行器持续间歇性故障的自适应补偿控制方法 |
CN110058600B (zh) * | 2019-02-26 | 2022-01-14 | 天津大学 | 三旋翼无人机舵机堵塞故障下位姿***的容错控制方法 |
CN110058600A (zh) * | 2019-02-26 | 2019-07-26 | 天津大学 | 三旋翼无人机舵机堵塞故障下位姿***的容错控制方法 |
CN110824925A (zh) * | 2019-11-29 | 2020-02-21 | 天津大学 | 倾转式三旋翼无人机的自适应鲁棒容错控制方法 |
CN111880410A (zh) * | 2020-08-11 | 2020-11-03 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN111880410B (zh) * | 2020-08-11 | 2021-12-28 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN113791544A (zh) * | 2021-11-15 | 2021-12-14 | 滨州学院 | 多旋翼无人机的控制方法、***、装置及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN106842952B (zh) | 2020-03-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106842952A (zh) | 针对三旋翼无人机舵机堵塞故障的容错控制方法 | |
CN106527137B (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN104965414B (zh) | 针对四旋翼无人机执行器部分失效的容错控制方法 | |
CN109343369B (zh) | 一种基于非线性观测器的四旋翼容错控制器设计方法 | |
Zhong et al. | Robust actuator fault detection and diagnosis for a quadrotor UAV with external disturbances | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
Madani et al. | Sliding mode observer and backstepping control for a quadrotor unmanned aerial vehicles | |
CN103135553B (zh) | 四旋翼飞行器容错控制方法 | |
Zhao et al. | Fault tolerant control for damaged aircraft based on sliding mode control scheme | |
CN103116357A (zh) | 一种具有抗干扰容错性能的滑模控制方法 | |
CN104022742A (zh) | 基于神经网络观测器的飞行器姿态鲁棒反演容错控制方法 | |
CN105867401A (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
Xu et al. | Decentralized asymptotic fault tolerant control of near space vehicle with high order actuator dynamics | |
CN104880948A (zh) | 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法 | |
CN110058600B (zh) | 三旋翼无人机舵机堵塞故障下位姿***的容错控制方法 | |
Saied et al. | Fault tolerant control for multiple successive failures in an octorotor: Architecture and experiments | |
CN104765312A (zh) | 飞行器可重构控制***实现方法 | |
Moncayo et al. | UAV adaptive control laws using non-linear dynamic inversion augmented with an immunity-based mechanism | |
Ortiz-Torres et al. | An actuator fault detection and isolation method design for planar vertical take-off and landing unmanned aerial vehicle modelled as a qLPV system | |
Islam et al. | Adaptive sliding mode control of unmanned four rotor flying vehicle | |
Gao et al. | EKF‐Based Actuator Fault Detection and Diagnosis Method for Tilt‐Rotor Unmanned Aerial Vehicles | |
Saied et al. | Passive fault-tolerant control of an octorotor using super-twisting algorithm: Theory and experiments | |
Saied et al. | Controllability analysis and motors failures symmetry in a coaxial octorotor | |
Okada et al. | Neuroadaptive Observer-Based Fault-Diagnosis and Fault-Tolerant Control for Quadrotor UAV | |
Mouhssine et al. | Quadrotor fault detection and isolation based on nonlinear analytical redundancy relations |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200306 |
|
CF01 | Termination of patent right due to non-payment of annual fee |