CN109343369B - 一种基于非线性观测器的四旋翼容错控制器设计方法 - Google Patents
一种基于非线性观测器的四旋翼容错控制器设计方法 Download PDFInfo
- Publication number
- CN109343369B CN109343369B CN201811374143.3A CN201811374143A CN109343369B CN 109343369 B CN109343369 B CN 109343369B CN 201811374143 A CN201811374143 A CN 201811374143A CN 109343369 B CN109343369 B CN 109343369B
- Authority
- CN
- China
- Prior art keywords
- fault
- attitude
- representing
- designing
- observer
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000013461 design Methods 0.000 title claims abstract description 30
- 230000001133 acceleration Effects 0.000 claims description 32
- 239000011159 matrix material Substances 0.000 claims description 30
- 238000009795 derivation Methods 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 8
- 230000006978 adaptation Effects 0.000 claims description 6
- 238000013459 approach Methods 0.000 claims description 6
- 238000012795 verification Methods 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 3
- 238000011897 real-time detection Methods 0.000 abstract description 4
- 238000011160 research Methods 0.000 description 7
- 238000003745 diagnosis Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 239000000654 additive Substances 0.000 description 4
- 230000000996 additive effect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000004088 simulation 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
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
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
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
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)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种基于非线性观测器的四旋翼容错控制器设计方法,该方法建立起四旋翼无人机的动力学模型,将无人机***分为姿态子***和位置子***;针对姿态子***建立故障模型,再设计非线性故障观测器,对未知的执行器故障进行实时检测和在线估计,利用获得的故障估计信息设计基于快速非奇异终端滑模方法的容错控制器;针对位置子***结合backstepping方法和滑模方法,通过设计中间虚拟量反解出位置子***控制率以及期望姿态角。本发明可以使四旋翼无人机在执行器发生故障情况下仍然能跟踪期望位置和偏航角,保证俯仰角和滚转角的稳定。
Description
技术领域
本发明涉及一种基于非线性观测器的四旋翼容错控制器设计方法,具体的说是一种四旋翼无人机的非线性故障观测器和滑模容错控制器的设计方法,属于飞行器自动控制技术领域。
背景技术
与传统飞机相比,四旋翼飞行器具有灵活,操作简便,成本低,垂直起降等优点。目前,它在新兴领域具有独特的优势和应用前景,如航空物流,生态环境监测,电力检测,封闭空间监测、测绘等。然而,四旋翼飞行器技术仍面临以下两个严峻挑战。一方面,由于外部干扰对飞行控制***的稳定性有很大影响,它无法自行处理未知情况。在飞行过程中,不仅容易受到各种物理因素的影响,例如气动力、重力、陀螺效应和转子惯性力矩等,而且也很容易受到外部环境的干扰,如气流、风力等。因此,在设计控制器时必须考虑外部干扰对飞行控制***稳定性的影响。另一方面,作为一个典型的欠驱动***,四旋翼无人机的位置和姿态是耦合的,这会导致模型的多变量,强耦合,非线性,且易受外部干扰。此外,执行器的高速旋转增加了飞行期间的故障概率。例如,电机插头卡住故障,转子叶片表面损坏,遥控信号丢失等,以上所有情况都可能导致其与输电线路和塔架发生碰撞,这往往会导致严重的飞行事故。因此,开发一种容错控制器具有迫切的现实意义,该控制器不仅需要具备精确控制飞机的能力,而且需要具有很强的抗干扰性和环境适应性,从而保证***稳定可靠。
据了解,现有技术中四旋翼无人机容错控制***的设计非常困难,因为其模型具有如上所述的多变量、非线性、强耦合等特性。国际上相关研究侧重于姿态控制器的设计和验证,研究结果表明非线性控制设计可以取得良好的控制效果。故障诊断与容错控制技术研究在航天器姿态控制***中取得了***的成果,但就目前热门的研究成果来说,仍存在以下两方面的问题:
一方面,在故障诊断研究方面,由于基于观测器的故障诊断技术可以充分利用被控***解析模型和***内部信息,可以实时有效地对***进行故障诊断、隔离,因此是一个重要的研究方向。但是该技术在四旋翼无人机上的实现相对较少。
另一方面,在容错控制方面,主要研究成果集中于基于状态观测器的状态反馈容错控制,但由于状态估计与故障估计之间存在耦合关系,在设计容错控制器时难以对状态反馈矩阵进行设计,增加了容错控制器设计的难度。
发明内容
本发明所要解决的技术问题是为了解决现有技术的不足,针对四旋翼无人机姿态控制***发生执行器故障的情况,提供了一种能够对未知故障进行在线实时检测与精确估计,并可以使***具有自主消除故障影响的能力,达到期望姿态、位置控制目标的四旋翼无人机故障诊断与容错控制技术。
为了解决上述问题,本发明的技术方案如下:
一种基于非线性观测器的四旋翼容错控制器设计方法,包括以下步骤:
S1、建立四旋翼无人机的动力学模型,将无人机***分为姿态子***和位置子***,该动力学模型具体如下,
其中,ai为常数并且i=1,2,3,4,5,6,7,8,9,φ代表相对于地面坐标系的侧滚角,θ代表相对于地面坐标系的俯仰角,ψ代表相对于地面坐标系的偏航角,表示侧滚角φ的角速度,表示俯仰角θ的角速度,表示偏航角ψ的角速度,表示侧滚角φ的角加速度,表示俯仰角θ的角加速度,表示偏航角ψ的角加速度;表示无人机在x方向的速度,表示无人机在y方向的速度,表示无人机在z方向的速度,表示无人机在x方向的加速度,表示无人机在y方向的加速度,表示无人机在z方向的加速度;S(*)表示sin(*),C(*)表示cos(*),U1为侧滚角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入, U4为位置***的控制输入,di为外部扰动且i=1,...,6,g为重力系数;
S2、针对姿态子***,采用内外环设计,建立姿态子***在无故障情况下的简化模型,该模型具体如下:
S3、建立姿态子***的故障模型,该模型具体如下:
进一步写成,
其中,uf表示故障情况下的控制输入,uf=(I+K)u0,定义 I+K=diag{1+k1,1+k2,1+k3}为故障向量,在实际情况和工程背景下,故障一般都是有界的,本发明考虑故障为常值故障,ki为故障系数,i=1,2,3,且满足|ki|<li,li为某正常数;
该故障建模方法具体描述如下:
当ki=0,uf=u0,表示***无故障情况;
当-1<ki<0,ufi=(1+ki)u0i,表示***发生加性故障;
其中,u0iand ufi分别为u0和uf的第i个分量,i=1,2,3;
S4、在考虑故障发生的情况下,建立非线性故障观测器,然后对未知的执行器故障进行实时检测和在线估计,即根据故障观测器所产生的残差信号,对故障的真实值进行实时在线估计,具体估计公式如下:
其中,:为姿态角的估计值, 为姿态角速率的估计值,e1、e2均为估计误差,且 为故障系数估计值,sgn为符号函数,L为观测器增益矩阵,且 L=diag{l1 l2 l3},且li为某正常数满足li>0(i=1,2,3),I为3阶单位矩阵,η为待设计参数,D为某未知常数,并用表示其估计值;
S5、根据步骤S4所获得的实时故障估计信息,设计姿态子***基于快速非奇异终端滑模方法的容错控制器;
S6、针对位置子***,结合backstepping方法和滑模方法,设计位置子***基于滑模backstepping方法的控制器,并通过设计中间虚拟量反解出位置子***控制率以及期望姿态角。
本发明建立了四旋翼无人机的非线性动力学模型,故障建模时考虑了加性和乘性两种形式的故障,采用非线性故障观测器,同时控制器设计结合了终端滑模、backstepping等方法。
其中,m为无人机的质量,Ix为x轴的转动惯量,Iy为y轴的转动惯量,Iz为z轴的转动惯量,l为电机到机体重心的距离,κ为拉力系数,g为重力系数,dx、dy、dz、dφ、dθ、dψ均为阻力系数;
U1、U2、U3、U4满足以下条件:
U1=lκ(Ω4 2-Ω2 2)/Ix
U2=lκ(Ω3 2-Ω1 2)/Iy
U 3=lκ(Ω2 2+Ω4 2-Ω1 2-Ω3 2)/Iz
U4=lκ(Ω1 2+Ω2 2+Ω3 2+Ω4 2)/m,
Ωi为电机的转速且i=1,2,3,4;
di满足|di|≤M,M为已知扰动上界,且M>0。
其中λ1和λ2均为待设计参数。
在步骤S5中,设计容错控制器的具体方法如下:
S501、根据下式设计快速非奇异终端滑模面s1,s2,s3,
其中,ε1、ε2,ε3均为实际姿态角与期望姿态角之间的跟踪误差,且ε1=φ-φd,ε2=θ-θd,ε3=ψ-ψd,φ-、θ、ψ均表示实际姿态角,φd、θd、ψd均表示期望姿态角,分别为三个跟踪误差的导数,ci(i=1,2,3...,6)和a1、a2均为滑模参数,满足ci>0,1<α2<2,α2<α1;
其中,si(i=1,2,3)为滑模面,m、n、γ为滑模参数,且满足 m,n>0,0<γ<1;
S503、结合步骤S1中所设计的滑模面、步骤S2中所设计的趋近律以及姿态***得模型,根据下式设计姿态子***的控制输入 U1,U2,U3:
在步骤S6中,在设计控制器前,首先需要定义位置跟踪误差为 z1=x-xd,z2=y-yd,z3=z-zd,其中,x、y、z分别表示实际位置,xd、yd、zd分别表示期望位置;
设计的位置x,y,z三个控制器具有相同的步骤和形式。
进一步的,位置x通道控制器设计控制器的方法如下:
S601、选取第一个Lyapunov函数,
S602、结合步骤S601选取的Lyapunov函数,设计虚拟控制量v2,
S603、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
本发明的方法还包括步骤S7、采用Lyapunov稳定性理论对姿态子***非线性故障观测器的稳定性进行验证,验证方法如下:
S701、建立估计误差***,
其中,为姿态角的估计值,为姿态角速率的估计值,且e1、e2均为估计误差,且 均为估计误差,且 为故障系数估计误差,sgn为符号函数,η为待设计参数,L=diag{l1 l2 l3},L 为观测器增益矩阵,且满足li>0(i=1,2,3);
S702、定义第一个Lyapunov函数,
其中,V1是指设计的Laypunov函数,σ为正常数,然后步骤S701 的估计误差***对V1进行求导得到,
S703、定义第二个Lyapunov函数,
(1)本发明考虑了加性和乘性故障,并与当前单故障模型相比,故障以统一的形式表示,本发明充分考虑了外部扰动的干扰,对于提高四旋翼无人机控制***对故障的容忍能力更具有实际意义;
(2)本发明设计了自适应非线性观测器,用于处理故障和干扰,能够精确估出故障值;
(3)本发明设计了姿态子***的容错控制器,利用故障观测器在线估计故障值,并且结合非奇异快速终端滑模面的设计,可以克服现有终端滑模控制的奇异性和不连续性;
(4)本发明结合了backstepping方法和滑模方法设计了位置子***的控制器,通过设计虚拟中间控制量反解出控制率,有效的通过一个控制输入完成对三个状态量的控制;
(5)本发明设计的方法具有较强的鲁棒性,可以准确实时的对执行器故障进行估计,并使四旋翼无人机在发生传感器故障时快速准确地跟踪上控制目标,更具有实际意义。
总之,本发明可以使四旋翼无人机在执行器发生故障的情况下仍然能够跟踪期望位置和偏航角,并保证俯仰角和滚转角的稳定。此外,在设计的过程中考虑了外部扰动对***造成的影响,并且通过仿真实验证明了所设计容错控制器的有效性。
附图说明
图1为本发明的容错控制流程图。
图2为本发明中无故障情况下位置x跟踪曲线图。
图3为本发明中无故障情况下位置y跟踪曲线图。
图4为本发明中无故障情况下位置z跟踪曲线图。
图5为本发明中无故障情况下无人机跟踪轨迹图。
图6为本发明中当执行器发生10%效率损失时,故障系数的估计值示意图。
图7为本发明中当执行器发生30%效率损失时,故障系数的估计值示意图。
图8为本发明中当执行器发生50%效率损失时,故障系数的估计值示意图。
图9为本发明中当执行器发生70%效率损失时,故障系数的估计值示意图。
图10为本发明中当执行器发生10%效率损失时,偏航角的跟踪曲线图。
图11为本发明中当执行器发生30%效率损失时,偏航角的跟踪曲线图。
图12为本发明中当执行器发生50%效率损失时,偏航角的跟踪曲线图。
图13为本发明中当执行器发生70%效率损失时,偏航角的跟踪曲线图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:为了本领域普通技术人员可以更好地了解本发明的实施,本发明还提供了利用Matlab2018a软件进行容错控制的仿真验证结果。
如图1所示,当四旋翼无人机执行器发生故障时,通过建立非线性故障观测器,对故障进行实时检测与估计,进一步利用故障估计信息设计姿态子***容错控制器,使得***在姿态容错控制器和位置控制器的控制下,仍能对目标指令进行跟踪。本实施例为一种基于非线性观测器的四旋翼容错控制器设计方法,包括以下步骤:
S1、建立四旋翼无人机的动力学模型,将无人机***分为姿态子***和位置子***,该动力学模型具体如下,
其中,m为无人机的质量,Ix为x轴的转动惯量,Iy为y轴的转动惯量,Iz为z轴的转动惯量,l为电机到机体重心的距离,κ为拉力系数,g为重力系数,dx、dy、dz、dφ、dθ、dψ均为阻力系数,Ωi为四个电机的转速且i=1,2,3,4。式中ai为常数并且i=1,2,3,4,5,6,7,8,9,具体表达式为: φ代表相对于地面坐标系的侧滚角,θ代表相对于地面坐标系的俯仰角,ψ代表相对于地面坐标系的偏航角,表示侧滚角φ的角速度,表示俯仰角θ的角速度,表示偏航角ψ的角速度,表示侧滚角φ的角加速度,表示俯仰角θ的角加速度,表示偏航角ψ的角加速度;表示无人机在x方向的速度,表示无人机在y方向的速度,表示无人机在 z方向的速度,表示无人机在x方向的加速度,表示无人机在y方向的加速度,表示无人机在z方向的加速度;S(*)表示sin(*),C(*)表示cos(*),U1为侧滚角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入,U4为位置***的控制输入,U1、U2、U3、U4满足以下条件:
U2=lκ(Ω3 2-Ω1 2)/Iy
di为外部扰动且i=1,...,6,并满足|di|≤M,M为已知扰动上界,且M>0。
S2、针对姿态子***,采用内外环设计,建立姿态子***在无故障情况下的简化模型,该模型具体如下:
S3、建立姿态子***的故障模型,该模型具体如下:
进一步写成,
其中,uf表示故障情况下的控制输入,uf=(I+K)u0,定义 I+K=diag{1+k1,1+k2,1+k3}为故障向量,在实际情况和工程背景下,故障一般都是有界的,本发明考虑故障为常值故障,ki为故障系数,i=1,2,3,且满足|ki|<li,li为某正常数;
该故障建模方法具体描述如下:
当ki=0,uf=u0,表示***无故障情况;
当-1<ki<0,ufi=(1+ki)u0i,表示***发生加性故障;
其中,u0iandufi分别为u0和uf的第i个分量,i=1,2,3。
S4、在考虑故障发生的情况下,建立非线性故障观测器,然后对未知的执行器故障进行实时检测和在线估计,即根据故障观测器所产生的残差信号,对故障的真实值进行实时在线估计,具体估计公式如下:
其中,为姿态角的估计值,为姿态角速率的估计值,e1、e2均为估计误差,且 为故障系数估计值,sgn为符号函数,L为观测器增益矩阵,且 L=diag{l1 l2 l3},且li为某正常数满足li>0(i=1,2,3),I为3阶单位矩阵,η为待设计参数,D为某未知常数,并用表示其估计值。为了处理观测器中的非线性项以及扰动项,假设D为某未知常数并用表示其估计值。η为待设计参数。
其中λ1和λ2均为待设计参数。
S5、根据步骤S4所获得的实时故障估计信息,设计姿态子***基于快速非奇异终端滑模方法的容错控制器。
设计容错控制器的具体方法如下:
S501、根据下式设计快速非奇异终端滑模面s1,s2,s3,
其中,ε1、ε2,ε3均为实际姿态角与期望姿态角之间的跟踪误差,且ε1=φ-φd,ε2=θ-θd,ε3=ψ-ψd,φ-、θ、ψ均表示实际姿态角,φd、θd、ψd均表示期望姿态角,分别为三个跟踪误差的导数,ci(i=1,2,3...,6)和a1、a2为均滑模参数,满足ci>0,1<α2<2,α2<α1;
其中,si(i=1,2,3)为滑模面,m、n、γ均为滑模参数,且满足 m,n>0,0<γ<1;
S503、结合步骤S1中所设计的滑模面、步骤S2中所设计的趋近律以及姿态***得模型,根据下式设计姿态子***的控制输入 U1,U2,U3:
为证明该容错控制器的稳定性,以滚转角为例,定义Lyapunov函数:
对V3求导,并将控制率U1带入:
同理可证俯仰角和偏航角控制器稳定。
S6、针对位置子***,结合backstepping方法和滑模方法,设计位置子***基于滑模backstepping方法的控制器,并通过设计中间虚拟量反解出位置子***控制率以及期望姿态角。
在设计控制器前,首先需要定义位置跟踪误差为z1=x-xd, z2=y-yd,z3=z-zd,其中,x、y、z分别表示实际位置,xd、yd、zd分别表示期望位置;跟踪误差的导数为 其中,分别表示机体沿x、y、z三个方向的线速度,分别表示机体沿x、y、z三个方向线速度的期望值;设计的位置x,y,z三个控制器具有相同的步骤和形式。以位置 x通道控制器设计为例,位置x通道控制器设计控制器的方法如下:
S601、选取第一个Lyapunov函数,
S602、结合步骤S601选取的Lyapunov函数,设计虚拟控制量v2,
对V5求导,并结合虚拟控制量v2以及位置子***的动力学方程:
S603、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
S7、采用Lyapunov稳定性理论对姿态子***非线性故障观测器的稳定性进行验证,验证方法如下:
S701、建立估计误差***,
其中,为姿态角的估计值,为姿态角速率的估计值,且e1、e2均为估计误差,且 均为估计误差,且 为故障系数估计误差,sgn为符号函数,η为待设计参数,L=diag{l1 l2 l3},L 为观测器增益矩阵,且满足li>0(i=1,2,3);
S702、定义第一个Lyapunov函数,
其中,V1是指设计的Laypunov函数,σ为正常数,然后步骤S701 的估计误差***对V1进行求导得到,
S703、定义第二个Lyapunov函数,
本实施例利用Matlab2018a软件,对所发明的容错控制方法进行了仿真验证:
四旋翼无人机控制***参数选取:
m=2kg,l=0.2m,κ=1.15×10-7N·s2·rad-2,Iy=Iy=1.25N·s2·rad-1,Iz=2.5N·s2·tad-1,
dx=dy=dz=0.01N·s·rad-1,dψ=dφ=dθ=0.012;
观测器参数选取:
l1=15,l2=5,l3=5,σ=1,δ=1,λ1=2,λ2=2;
控制器参数选取:
c1=c3=c5=1,c2=c4=c5=2,a1=3,a2=1.5,γ=0.6,m=30,n=30,μ1=μ2=μ3=10,l1=l2=l3=10:
期望信号:
xd=cos(t),yd=sin(t),zd=0.5t,ψd=sin(0.5t),外部干扰取di=2sin(t),(i=1,...,6)。
结果说明:
如图2-5所示,当无故障发生时,无人机在本实施例所设计位置控制器的控制下,能快速跟踪期望轨迹。
如图6-9所示,当发生执行器故障时,故障估计值能在4s内收敛至故障真实值,且能估计不同程度的故障(10%-70%效率损失)。
如图10-13所示,当效率损失比较小的情况下(10%,30%),无人机在本实施例所设计的姿态容错控制器的控制下,仍能保持良好的跟踪性能。当效率损失比较大的情况下(50%,70%),跟踪性能稍差但仍在可接受范围内。
以上所述,仅为本发明中的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉该技术的人在本发明所揭露的技术范围内,可理解想到的变换或替换,都应涵盖在本发明的包含范围之内,因此,本发明的保护范围应该以权利要求书的保护范围为准。
Claims (4)
1.一种基于非线性观测器的四旋翼容错控制器设计方法,其特征在于,包括以下步骤:
S1、建立四旋翼无人机的动力学模型,该模型具体如下,
其中,ai为常数并且i=1,2,3,4,5,6,7,8,9,φ代表相对于地面坐标系的侧滚角,θ代表相对于地面坐标系的俯仰角,ψ代表相对于地面坐标系的偏航角,表示侧滚角φ的角速度,表示俯仰角θ的角速度,表示偏航角ψ的角速度,表示侧滚角φ的角加速度,表示俯仰角θ的角加速度,表示偏航角ψ的角加速度;表示无人机在x方向的速度,表示无人机在y方向的速度,表示无人机在z方向的速度,表示无人机在x方向的加速度,表示无人机在y方向的加速度,表示无人机在z方向的加速度;S(*)表示sin(*),C(*)表示cos(*),U1为侧滚角的控制输入,U2为俯仰角的控制输入,U3为偏航角的控制输入,U4为位置***的控制输入,di为外部扰动且i=1,...,6,g为重力系数;
S2、采用内外环设计,建立姿态子***在无故障情况下的简化模型,该模型具体如下:
S3、建立姿态子***的故障模型,该模型具体如下:
其中,I+K=diag{1+k1,1+k2,1+k3},ki为故障系数,i=1,2,3,且满足|ki|<li,li为某正常数;
S4、在考虑故障发生的情况下,建立故障观测器,根据故障观测器所产生的残差信号,对故障的真实值进行实时在线估计,具体估计公式如下:
其中,为姿态角的估计值, 为姿态角速率的估计值,e1、e2均为估计误差,且 为故障系数估计矩阵,sgn为符号函数,L为观测器增益矩阵,且L=diag{l1l2l3},I为3阶单位矩阵,η为待设计参数,D为某未知常数,并用表示其估计值;
S5、根据步骤S4所获得的实时故障估计信息,设计姿态子***基于快速非奇异终端滑模方法的容错控制器;设计容错控制器的具体方法如下:
S501、根据下式设计快速非奇异终端滑模面s1,s2,s3,
其中,ε1、ε2,ε3均为实际姿态角与期望姿态角之间的跟踪误差,且ε1=φ-φd,ε2=θ-θd,ε3=ψ-ψd,φ、θ、ψ均表示实际姿态角,φd、θd、ψd均表示期望姿态角,分别为三个跟踪误差的导数,ci、a1、a2均为滑模参数,满足ci>0,1<α2<2,α2<α1;
其中,si为滑模面,m、n、γ均为滑模参数,且满足m,n>0,0<γ<1;
S503、结合步骤S501中所设计的滑模面、步骤S502中所设计的趋近律以及姿态***的模型,根据下式设计姿态子***的控制输入U1,U2,U3:
S6、设计位置子***基于滑模backstepping方法的控制器;在设计控制器前,首先需要定义位置跟踪误差为z1=x-xd,z2=y-yd,z3=z-zd,其中,x、y、z分别表示实际位置,xd、yd、zd分别表示期望位置;
设计的位置x,y,z三个控制器具有相同的步骤和形式;
位置x通道控制器设计控制器的方法如下:
S601、选取第一个Lyapunov函数,
S602、结合步骤S601选取的Lyapunov函数,设计虚拟控制量v2,
S603、给定偏航角的期望信号ψd,通过步骤S4所设计的姿态控制器,有ψ→ψd,因而利用虚拟控制量可以获得,
4.根据权利要求1所述一种基于非线性观测器的四旋翼容错控制器设计方法,其特征在于,还包括步骤S7、对姿态子***非线性故障观测器的稳定性进行验证,验证方法如下:
S701、建立估计误差***,
S702、定义第一个Lyapunov函数,
其中,σ为正常数,然后步骤S701的估计误差***对V1进行求导得到,
S703、定义第二个Lyapunov函数,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811374143.3A CN109343369B (zh) | 2018-11-19 | 2018-11-19 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811374143.3A CN109343369B (zh) | 2018-11-19 | 2018-11-19 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109343369A CN109343369A (zh) | 2019-02-15 |
CN109343369B true CN109343369B (zh) | 2021-08-10 |
Family
ID=65316108
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811374143.3A Active CN109343369B (zh) | 2018-11-19 | 2018-11-19 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109343369B (zh) |
Families Citing this family (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109885074B (zh) * | 2019-02-28 | 2022-02-15 | 天津大学 | 四旋翼无人机有限时间收敛姿态控制方法 |
CN109884895B (zh) * | 2019-03-11 | 2022-03-11 | 南京邮电大学 | 基于饱和受限情况下的无人机自适应跟踪控制算法 |
CN109947134B (zh) * | 2019-04-30 | 2022-05-17 | 南京邮电大学 | 基于多无人机分布式控制的四旋翼无人机编队容错方法 |
CN110221539B (zh) * | 2019-05-17 | 2022-04-08 | 江苏理工学院 | 基于线性扩张观测器的四旋翼非奇异终端滑模控制方法 |
CN110231828B (zh) * | 2019-05-31 | 2020-07-21 | 燕山大学 | 基于非奇异快速终端滑模的四旋翼无人机视觉伺服控制方法 |
CN110244697B (zh) * | 2019-06-26 | 2020-05-26 | 哈尔滨工业大学 | 基于复合观测器的垂直起降飞行器复杂故障诊断辨识方法 |
CN110262557B (zh) * | 2019-07-16 | 2020-04-21 | 南京航空航天大学 | 基于滑模控制技术的四旋翼编队有限时间容错控制方法 |
CN110427043B (zh) * | 2019-09-04 | 2021-09-28 | 福州大学 | 基于作业飞行机器人重心偏移的位姿控制器设计方法 |
CN110502027B (zh) * | 2019-09-16 | 2022-08-12 | 南京邮电大学 | 一种基于自适应终端滑模的四旋翼无人机姿态容错控制方法 |
CN110673544B (zh) * | 2019-09-27 | 2022-11-18 | 上海大学 | 基于自适应在线学习的上肢康复机器人控制方法 |
CN111142549B (zh) * | 2019-12-30 | 2021-03-02 | 北京航空航天大学 | 一种无人机姿态控制***抗干扰攻击检测与自愈控制器及控制方法 |
CN111562794B (zh) * | 2020-04-08 | 2021-09-14 | 中南大学 | 执行器故障和输入量化的航天器姿态控制方法 |
CN113767352A (zh) * | 2020-05-07 | 2021-12-07 | 深圳市大疆创新科技有限公司 | 控制方法、数据处理方法、设备、无人机及存储介质 |
CN111522241B (zh) * | 2020-05-08 | 2020-12-29 | 哈尔滨工业大学 | 一种基于固定时间观测器的主动容错控制方法及装置 |
CN111722634B (zh) * | 2020-05-28 | 2022-09-23 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
CN111722614B (zh) * | 2020-06-15 | 2021-07-09 | 南京航空航天大学 | 一种基于广义观测器的四旋翼无人机故障估计方法 |
CN111679658B (zh) * | 2020-06-29 | 2021-06-11 | 哈尔滨工业大学 | 不确定非线性控制***的自适应故障检测与隔离方法 |
CN111982100B (zh) * | 2020-07-07 | 2022-05-06 | 广东工业大学 | 一种无人机的航向角解算算法 |
CN111948944B (zh) * | 2020-08-07 | 2022-04-15 | 南京航空航天大学 | 一种基于自适应神经网络的四旋翼编队容错控制方法 |
CN112015192B (zh) * | 2020-08-11 | 2021-11-19 | 北京航空航天大学 | 一种自愈四旋翼无人机抗干扰控制方法与*** |
CN112180960B (zh) * | 2020-09-29 | 2021-09-14 | 西北工业大学 | 一种面向执行器故障的无人机容错飞行方法及飞行*** |
CN113009932B (zh) * | 2021-03-11 | 2022-11-08 | 南京邮电大学 | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 |
CN113050427B (zh) * | 2021-03-25 | 2022-05-10 | 南京航空航天大学 | 一种执行器故障下非线性***快速终端滑模容错控制方法 |
CN113093782B (zh) * | 2021-04-12 | 2023-07-18 | 广东工业大学 | 一种无人机指定性能姿态控制方法及*** |
CN113568419B (zh) * | 2021-05-18 | 2023-09-12 | 南京邮电大学 | 一种变载四旋翼无人机容错控制方法 |
CN113625730B (zh) * | 2021-06-30 | 2023-07-14 | 南京邮电大学 | 一种基于超扭滑模的四旋翼自适应容错控制方法 |
CN113568423B (zh) * | 2021-08-01 | 2024-01-16 | 西北工业大学 | 一种考虑电机故障的四旋翼无人机智能容错控制方法 |
CN113741188B (zh) * | 2021-08-31 | 2023-07-11 | 南京航空航天大学 | 执行器故障下固定翼无人机反步自适应容错控制方法 |
CN113741194B (zh) * | 2021-09-09 | 2022-04-15 | 河海大学 | 基于切换非线性电子线路***的自适应容错控制方法及*** |
CN113777932B (zh) * | 2021-11-15 | 2022-02-22 | 南京信息工程大学 | 一种基于Delta算子的四旋翼自适应滑模容错控制方法 |
CN113934143B (zh) * | 2021-11-24 | 2023-08-22 | 苏州科技大学 | 多旋翼飞行器有限时间自适应事件触发容错跟踪控制方法 |
CN114237054A (zh) * | 2021-12-18 | 2022-03-25 | 福州大学 | 空中机器人的6d交互控制方法 |
CN114489105B (zh) * | 2022-01-25 | 2024-01-16 | 南京邮电大学 | 基于干扰观测器的新型无人机姿态***积分滑模控制方法 |
CN114859706B (zh) * | 2022-03-11 | 2024-05-10 | 合肥工业大学 | 一种电动代步车***的主动容错控制方法 |
CN114779638B (zh) * | 2022-04-20 | 2023-01-31 | 西安工业大学 | 无人直升机多故障检测与辨识方法 |
CN115016520A (zh) * | 2022-06-21 | 2022-09-06 | 南京航空航天大学 | 一种姿态同步控制***的自适应固定时间故障估计方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854874A (zh) * | 2012-06-18 | 2013-01-02 | 南京航空航天大学 | 一种基于联合多观测器的故障诊断与容错控制装置及方法 |
CN104020774A (zh) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | 基于动态控制重新分配的飞行器姿态容错控制方法 |
CN104049638A (zh) * | 2014-06-19 | 2014-09-17 | 金陵科技学院 | 执行器动态的飞行器姿态分散式容错控制*** |
CN106527137A (zh) * | 2016-11-25 | 2017-03-22 | 天津大学 | 基于观测器的四旋翼无人机容错控制方法 |
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6662089B2 (en) * | 2002-04-12 | 2003-12-09 | Honeywell International Inc. | Method and apparatus for improving fault classifications |
-
2018
- 2018-11-19 CN CN201811374143.3A patent/CN109343369B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102854874A (zh) * | 2012-06-18 | 2013-01-02 | 南京航空航天大学 | 一种基于联合多观测器的故障诊断与容错控制装置及方法 |
CN104020774A (zh) * | 2014-06-19 | 2014-09-03 | 金陵科技学院 | 基于动态控制重新分配的飞行器姿态容错控制方法 |
CN104049638A (zh) * | 2014-06-19 | 2014-09-17 | 金陵科技学院 | 执行器动态的飞行器姿态分散式容错控制*** |
CN106527137A (zh) * | 2016-11-25 | 2017-03-22 | 天津大学 | 基于观测器的四旋翼无人机容错控制方法 |
CN107479567A (zh) * | 2017-09-13 | 2017-12-15 | 山东大学 | 动态特性未知的四旋翼无人机姿态控制器及方法 |
Non-Patent Citations (1)
Title |
---|
四旋翼飞行器的容错姿态稳定控制;宫勋 等;《电光与控制》;20140731;第21卷(第7期);第14-18页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109343369A (zh) | 2019-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109343369B (zh) | 一种基于非线性观测器的四旋翼容错控制器设计方法 | |
Hou et al. | Nonsingular terminal sliding mode control for a quadrotor UAV with a total rotor failure | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
Avram et al. | Nonlinear adaptive fault-tolerant quadrotor altitude and attitude tracking with multiple actuator faults | |
Madani et al. | Sliding mode observer and backstepping control for a quadrotor unmanned aerial vehicles | |
CN108803317B (zh) | 自适应多变量四旋翼无人机有限时间容错控制方法 | |
CN104049638B (zh) | 执行器动态的飞行器姿态分散式容错控制*** | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制***及工作方法 | |
CN106527137A (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN113568419B (zh) | 一种变载四旋翼无人机容错控制方法 | |
CN108647442B (zh) | 一种基于辅助输出的六旋翼无人机故障估计方法 | |
CN113741188B (zh) | 执行器故障下固定翼无人机反步自适应容错控制方法 | |
CN106842952A (zh) | 针对三旋翼无人机舵机堵塞故障的容错控制方法 | |
CN110488603B (zh) | 一种考虑执行器受限问题的刚性飞行器自适应神经网络跟踪控制方法 | |
CN113568423B (zh) | 一种考虑电机故障的四旋翼无人机智能容错控制方法 | |
CN107817818B (zh) | 一种模型不确定飞艇航迹跟踪有限时间控制方法 | |
Yan et al. | Adaptive tracking flight control for unmanned autonomous helicopter with full state constraints and actuator faults | |
CN113625730B (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
Saied et al. | Passive fault-tolerant control of an octorotor using super-twisting algorithm: Theory and experiments | |
CN113867374A (zh) | 基于滑模控制的四旋翼无人机参数预测和扰动的自适应轨迹跟踪控制器及其设计方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN114995163B (zh) | 一种无人机免疫控制方法 | |
CN114415516B (zh) | 一种固定翼飞机舵面损伤故障容错控制方法 | |
CN115421376A (zh) | 具有外部扰动和执行器故障的四旋翼无人机预定性能滑模容错控制方法 | |
CN115373275A (zh) | 四旋翼无人机的指定时间预定性能容错控制方法 |
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 |