CN104007663B - 一种含参数不确定性的四旋翼姿态自适应容错控制方法 - Google Patents
一种含参数不确定性的四旋翼姿态自适应容错控制方法 Download PDFInfo
- Publication number
- CN104007663B CN104007663B CN201410202218.5A CN201410202218A CN104007663B CN 104007663 B CN104007663 B CN 104007663B CN 201410202218 A CN201410202218 A CN 201410202218A CN 104007663 B CN104007663 B CN 104007663B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mover
- msup
- parameter
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000003044 adaptive effect Effects 0.000 claims abstract description 23
- 239000011159 matrix material Substances 0.000 claims description 33
- 230000004927 fusion Effects 0.000 claims description 9
- 238000005096 rolling process Methods 0.000 claims description 8
- 238000004088 simulation Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 3
- 238000001816 cooling Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 4
- 230000004044 response Effects 0.000 description 5
- 230000003321 amplification Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000003199 nucleic acid amplification method Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种含参数不确定性的四旋翼姿态自适应容错控制方法,属于四旋翼直升机姿态控制系统容错控制技术领域。通过运用模型参考自适应控制的思想,引入状态及其误差的反馈,设计了一种直接自适应容错控制方法,该方法既实现了对四旋翼直升机系统的参数不确定性、外部干扰以及执行器部分损失故障的补偿,又保证了四旋翼直升机的姿态角对参考系统状态的有界跟踪。
Description
技术领域
本发明涉及一种含参数不确定性的四旋翼姿态自适应容错控制方法,属于四旋翼直升机姿态控制系统容错控制技术领域。
背景技术
由于四旋翼直升机非线性、多变量以及高度耦合等特性,使其在飞行过程中对自身重力、陀螺效应等多种物理因素的影响敏感,因此很难获得精确的气动性能参数,从而建立精确有效的四旋翼直升机动力学模型。四旋翼直升机姿态控制系统是保证直升机正常运行的重要组成部分,对直升机的飞行性能和安全性起到非常关键的作用。但由于直升机飞行控制系统部件较多,且对大气流等外部环境的干扰敏感,这些干扰不仅会严重影响四旋翼直升机的飞行安全,还会引发执行器、传感器等部件发生故障,因此针对四旋翼直升机系统的参数不确定性,外部干扰以及执行器故障进行容错控制算法研究具有极其重要的研究价值。容错控制算法的设计使得四旋翼直升机在故障发生时,在很短的时间内即可恢复平稳飞行,从而大大提高飞行的安全性。
自适应容错控制技术可以分为两种方法:直接自适应控制方法和间接自适应控制方法;间接自适应控制方法需要先对被控对象的参数以及外部干扰,故障等信息进行辨识,然后进行控制器的设计,即首先对飞行参数直接在线估计,根据估计结果来确定控制器参数。而直接自适应控制方法无需事先知道被控系统以及干扰、故障等参数的确切信息,根据系统误差响应即可直接在线调节控制器的参数,保证了容错控制的快速性,且无需单独的故障诊断与辨识模块,可以在故障发生的第一时间内即对控制系统进行容错控制。
在现有的自适应容错控制方法中,大多仅仅研究了含参数不确定性四旋翼直升机的外部干扰补偿控制问题,很少的文献综合考虑了含系统参数不确定、外部干扰以及执行器故障的四旋翼直升机的容错控制问题。
发明内容
本发明提供了一种含参数不确定性的四旋翼姿态自适应容错控制方法。
本发明为解决其技术问题采用如下技术方案:
一种含参数不确定性的四旋翼姿态自适应容错控制方法,包括如下步骤:
步骤1、考虑外界扰动以及执行器部分失效故障,建立含参数不确定性的四旋翼直升机姿态控制系统模型;
步骤2、使用软件实现干扰与故障注入,通过对输出电压的调整,模拟部分损失故障;
步骤3、通过数据采集卡中采集的状态信息和由此计算出的误差信息,设计直接自适应容错控制律,即四旋翼姿态容错控制器,实时监测俯仰、滚转、偏航方向上的执行器故障和其他干扰,并将容错控制律重新输出至数据采集卡中,经功率放大器放大信号幅值,将此控制信号传输给电机执行。
步骤1中建立的四旋翼直升机姿态控制系统的模型描述如下:
其中x(t)为四旋翼直升机姿态控制系统模型的状态信号,由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;u(t)为四旋翼直升机姿态控制系统的电机输入信号,即容错控制器输出至功率放大器的信号;ω(t)代表未知的外部干扰信号,由步骤2中通过matlab软件注入得到,在设计容错控制律时为未知量。
式(1)中,其他参数或参数矩阵含义如下:
A,B分别为直升机姿态系统的状态矩阵和控制矩阵,通过四旋翼的系统辨识得到;ΔA为未知量,表示系统的参数不确定性,满足匹配条件ΔA=BN(t),N(t)未知但有上界,即存在未知参数l*,使得||N(t)||≤l*;Bω∈Rn×m为未知量,表示干扰信号的参数矩阵,满足匹配条件Bω=BF,F已知且有上界,即||F||≤λf。
步骤2中干扰与故障注入使用matlab软件,系统模型参数A、B,系统受到的外界扰动ω(t)、故障模式需分别满足以下3个假设条件:
假设1:在任何故障模式下,{A,Bρ}均完全可控,即存在矩阵满足:
且存在满足:
假设2:外部干扰均分段连续且有界,并且存在以及未知正常数满足:
假设3:对于可能发生的任何故障模式,假设剩余的其它控制器仍然有能力保证控制目标得以实现;
干扰通过设置ω(t)、F、N(t)注入,故障注入通过改变电机输入即控制器输出u(t)实现,在执行器发生部分失效故障时,式(3)中的控制器输出uF(t)可表示为:
uF(t)=ρu(t),ρ=diag(ρ1,ρ2,…,ρm) (5)
其中ρj∈[0,1],j=1,2,…,m表征执行器的部分失效程度。
步骤3中直接自适应容错控制律具体步骤如下:
首先确定四旋翼姿态控制系统(1)跟踪的参考系统:参考输入信号r(t)由matlab软件发出指令得到,需设计参考系统的状态矩阵Am∈Rn×n和控制矩阵Bm∈Rn×l,使得系统满足响应快、稳定性好的性能指标,并得到参考状态xm(t),参考系统的表达形式如下:
为满足性能指标,设计Am,使其所有特征根均位于复平面的左半轴,且r(t)∈Rl,满足一致连续且有界;
四旋翼姿态自适应容错控制器设计时所需的输入由状态信号x(t)及状态跟踪误差信号e(t)组成,均从式(1)中获得,其中状态信号x(t)由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;误差信号e(t)由参考模型中的状态量参考值xm(t)与上述状态信息x(t)相减得到,由此输入,设计直接自适应容错控制律的如下:
u(t)=K1 Tx(t)+K2 Tr(t)+(K3+K4)e(t) (7)
其中,u(t)为四旋翼直升机姿态控制系统的控制器输出信号,即功率放大器的输入信号;r(t)为参考系统的输入信号;
式(7)中,其他参数或参数矩阵含义如下:
K1 T=[k11,k12,…,k1m]T,K2 T=[k21,k21,…,k2m]T分别为系统状态x(t)和参考输入r(t)的反馈矩阵,用来对系统发生的部分失效故障进行容错控制,并保证直升机的姿态角有界跟踪参考状态xm(t);K3,K4为误差反馈矩阵,分别用来抵消外部干扰和参数不确定性对系统的影响;
由假设2可知则存在正常数l1 *满足以下不等式
定义参数如下:
由假设3可知ρ≠0,则存在正常数μ使下式成立
||eTPBρBTPe||≥μ||eTPB||2 (10)
式(7)中u(t)中控制器参数分别为假设条件中矩阵 的估计值,控制参数k1j,k2j的自适应律分别为:
其中Γ1j∈Rn×n,Γ2j∈Rl×l为任意的常数矩阵,且满足
式(7)中u(t)中控制器参数K3、K4可设计为:
式(12)、(13)中,l1、l2的自适应律分别为
l1、l2分别为和的估计值,γ3和γ4均为一任意正常数,δ(t)∈R+为任意一个一致连续有界函数,并满足
式(12)、(13)中,P∈Rn×n,P=PT>0且对任意的常数矩阵Q∈Rn×n,Q=QT>0满足
其中,ε为一任意正常数;
所设计出的控制器输出信号u(t)由式(7)得到,其中的自适应参数K1 T、K2 T、K3和K4由式(11)-(13)获得,其中参数满足式(14)-(16)的要求;输出信号u(t)传输至四旋翼的数据采集卡中,并经过功率放大器,传送至四旋翼电机中执行动作,此过程循环反复,直至四旋翼直升机系统的参数不确定性、外部干扰以及执行器部分损失故障完全被补偿、系统状态跟踪参考模型状态为止。
本发明的有益效果如下:
该方法不仅能够对四旋翼直升机系统的参数不确定性,外部干扰以及执行器部分失效故障进行补偿控制,还能够确保直升机的姿态角有界跟踪参考系统的状态输出,另外还具有控制结构简单等特点。
附图说明
图1为本发明的四旋翼姿态自适应容错控制框图。
图2为本发明设计的一种含参数不确定性的四旋翼直升机姿态控制系统直接自适应容错控制算法的数字仿真结果,执行器故障以及外部干扰下的偏航角跟踪误差图。
图3本发明设计的一种含参数不确定性的四旋翼直升机姿态控制系统直接自适应容错控制算法的数字仿真结果,为执行器故障以及外部干扰下的俯仰角跟踪误差图。
图4本发明设计的一种含参数不确定性的四旋翼直升机姿态控制系统直接自适应容错控制算法的数字仿真结果,为执行器故障以及外部干扰下的滚转角跟踪误差图。
具体实施方式
下面结合附图对本发明创造作进一步详细的说明。
本发明设计了一种含参数不确定性的四旋翼姿态自适应容错控制方法,控制框图如图1所示,具体步骤如下:
步骤1、基于以下假设条件对四旋翼直升机姿态控制系统进行建模:
(1)四旋翼直升机为完全均匀对称的刚性结构;
(2)直流电机的输入电压和输出力矩之间呈线性函数关系;
(3)四旋翼直升机的质心O和机体坐标系的原点O完全重合;
(4)地面坐标系为惯性坐标系,不考虑地球曲率以及重力加速度随高度而变化等因素的影响;
(5)飞行器姿态角度变化很小,假定小于5°。
可得其俯仰轴、横滚轴和航向轴方程为:
式中y、p、r分别表示偏航角、俯仰角和横滚角,分别为偏航角、俯仰角和横滚角的角加速度。Kfc、Kfn分别为顺时针、逆时针电压-力矩系数,Jp为机体绕着俯仰轴的转动惯量,Jr为机体绕着横滚轴的转动惯量,Vf、Vb、Vl、Vr分别为四旋翼直升机前、后、左、右四个电机的驱动电压值,l为坐标原点到电机中心点的距离。
由此建立的四旋翼直升机姿态控制系统的模型可描述如下:
其中x(t)为四旋翼直升机姿态控制系统模型的状态信号,由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;u(t)为四旋翼直升机姿态控制系统的电机输入信号,即容错控制器输出至功率放大器的信号;ω(t)代表未知的外部干扰信号,由步骤2中得到,通过matlab软件注入,在设计容错控制律时为未知量。
式(2)中,其他参数或参数矩阵含义如下:
A,B分别为直升机姿态系统的状态矩阵和控制矩阵,通过四旋翼的系统辨识得到;ΔA为未知量,表示系统的参数不确定性,满足匹配条件ΔA=BN(t),N(t)未知但有上界,即存在未知参数l*,使得||N(t)||≤l*;Bω∈Rn×m为未知量,表示干扰信号的参数矩阵,满足匹配条件Bω=BF,F已知且有上界,即||F||≤λf。
步骤2、使用matlab软件实现干扰与故障注入。系统模型参数A、B,系统受到的外界扰动ω(t)、故障模式需分别满足以下3个假设条件:
假设1:在任何故障模式下,{A,Bρ}均完全可控,即存在矩阵满足:
且存在满足:
假设2:外部干扰均分段连续且有界,并且存在以及未知正常数满足:
假设3:对于可能发生的任何故障模式,假设剩余的其它控制器仍然有能力保证控制目标得以实现。
干扰通过设置ω(t)、F、N(t)注入,故障注入通过改变电机输入即控制器输出u(t)实现,在执行器发生部分失效故障时,控制器输出uF(t)可表示为:
uF(t)=ρu(t),ρ=diag(ρ1,ρ2,…,pm) (6)
其中ρj∈[0,1],j=1,2,…,m表征执行器的部分失效程度。
步骤3、直接自适应容错控制律具体设计步骤如下:
首先确定四旋翼姿态控制系统(1)跟踪的参考系统。参考输入信号r(t)由matlab软件发出指令得到,需设计参考系统的状态矩阵Am∈Rn×n和控制矩阵Bm∈Rn×l,使得系统满足响应快、稳定性好的性能指标,并得到参考状态xm(t)。参考系统的表达形式如下:
为满足性能指标,设计Am,使其所有特征根均位于复平面的左半轴,且r(t)∈Rl,满足一致连续且有界。
四旋翼姿态自适应容错控制器设计时所需的输入由状态信号x(t)及状态跟踪误差信号e(t)组成,均从式(2)中获得,其中状态信号x(t)由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;误差信号e(t)由参考模型中的状态量参考值xm(t)与上述状态信息x(t)相减得到。由此输入,设计直接自适应容错控制律的如下:
u(t)=K1 Tx(t)+K2 Tr(t)+(K3+K4)e(t) (8)
其中,u(t)为四旋翼直升机姿态控制系统的控制器输出信号,即功率放大器的输入信号;r(t)为参考系统的输入信号。
式(8)中,其他参数或参数矩阵含义如下:
K1 T=[k11,k12,…,k1m]T,K2 T=[k21,k21,…,k2m]T分别为系统状态x(t)和参考输入r(t)的反馈矩阵,用来对系统发生的部分失效故障进行容错控制,并保证直升机的姿态角有界跟踪参考状态xm(t);K3,K4为误差反馈矩阵,分别用来抵消外部干扰和参数不确定性对系统的影响。
基于上述假设条件,本发明所提供的一种含参数不确定性的四旋翼姿态自适应容错控制方法,可采用如下证明方法获得:
定义状态跟踪误差信号
e(t)=x(t)-xm(t) (9)
将设计的直接自适应容错控制律(8)代入被控系统模型(2)可得:
定义参数误差变量将其代入上式,并根据假设条件(3)-(5),可得
对公式(9)求导,并代入公式(2)及(7),有
选择Lyapunov函数:
其中对上式求导,并代入式(12)可得:
根据模型参考自适应控制的思想,若参数k1j,k2j,j=1,2,…,m的自适应律选择为:
其中Γ1j∈Rn×n,Γ2j∈Rl×l为任意的常数矩阵,且满足P∈Rn×n,P=PT>0且对任意的常数矩阵Q∈Rn×n,Q=QT>0满足
ε为一任意正常数。
将矩阵B按列展开,并代入参数自适应律(15)-(16),有
由假设3可知ρ≠0,则存在正常数μ使下式成立
||eTPBρBTPe||≥μ||eTPB||2 (19)
由假设2可知则存在正常数l1*满足以下不等式
此处引入参数并定义如下:
则控制器参数K3,K4可设计为:
其中δ(t)∈R+为任意一个一致连续有界函数,并满足
l1,l2分别为和的估计值,且其自适应律为:
由于
成立,故
其中η为任意一个正常数。
由式(20)可得:
将公式(17)和式(28)-(29)代入式(14),可得:
代入控制律(22)-(23),并根据式(19),可得:
将式(25)-(26)代入上式,有:
其中
当不等式(32)的右边不含第二项时,由于δ(t)满足公式(24),通过引入Barbalat引理,可以证明此时当存在第二项时,由于可以随意取,当其取值很小时,根据李亚普诺夫第二稳定性理论即可证明:本章设计的控制器可以保证系统的状态跟踪误差被限定在一个很小的界内,即实现系统状态的有界跟踪。
所设计出的控制器输出信号u(t)传输至四旋翼的数据采集卡中,并经过功率放大器,传送至四旋翼电机中执行动作。此过程循环反复,直至四旋翼直升机系统的参数不确定性、外部干扰以及执行器部分损失故障完全被补偿、系统状态跟踪参考模型状态为止。
进行仿真时,选定参数及测试过程如下:
步骤1:选定被控系统(2)中参数信息,选定N(t)和F。并设定某一故障和干扰,包括故障和干扰的类型、起始时间、结束时间以及大小,其中故障的形式需满足公式(6),干扰则需满足公式(5)。
步骤2:根据四旋翼直升机姿态控制系统模型参数及其性能要求,选定参考系统(7),其中参考系统的参数需满足假设条件中公式(3)-(4)以及公式(17)。
步骤3:搭建被控系统和参考系统模块的模型,并根据控制器结构(8)以及控制器参数及其自适应律(15)-(16)、(22)-(23)以及(25)-(26),设定参数信息,构建自适应容错控制模块的模型。
步骤4:按照设定的故障及外部干扰类型、大小以及起止时间,给系统注入故障及干扰。
步骤5:自适应容错控制器根据测量出的姿态角跟踪误差e(t)以及状态信息x(t),计算出四旋翼直升机姿态控制系统的控制量,并将计算得到的控制量输出给执行器;
步骤6:不断重复步骤5,即可得到最终的仿真结果。
本发明设计的一种含参数不确定性的四旋翼姿态自适应容错控制方法,在具体实施过程当中的参数设置如下:
1.被控系统参数、执行器故障以及外部干扰分别为:
ω(t)=[1,2,3,0.1sin(0.5t)]T,t≥0,ρ=diag(0,1,1,1),t≥40s,
2.参考系统参数选取如下:
r=[1,1]T,Q=10*I6。
3.控制器参数设置为:Γ1i=10*I6,Γ2i=10*I2,γ3i=20,γ4=0.05,γ5=0.05,η=100。
4.按照上述参数对本发明算法进行仿真,可得执行器故障以及外部干扰下,姿态角跟踪误差仿真曲线分别如说明书附图2、图3、图4所示。由图2、图3、图4可以看出,三个姿态角跟踪在10秒内趋于稳定,响应时间比较短,系统响应超调量较小。从以上分析可以得知,本专利提出的一种含参数不确定性的四旋翼姿态自适应容错控制方法控制效果良好。
Claims (1)
1.一种含参数不确定性的四旋翼姿态自适应容错控制方法,包括如下步骤:
步骤1、考虑外界扰动以及执行器部分失效故障,建立含参数不确定性的四旋翼直升机姿态控制系统模型;模型描述如下:
<mrow>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>A</mi>
<mo>+</mo>
<mi>&Delta;</mi>
<mi>A</mi>
<mo>)</mo>
</mrow>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>B</mi>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>&omega;</mi>
</msub>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中x(t)为四旋翼直升机姿态控制系统模型的状态信号,由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;u(t)为四旋翼直升机姿态控制系统的电机输入信号,即容错控制器输出至功率放大器的信号;ω(t)代表未知的外部干扰信号,由步骤2中通过matlab软件注入得到,在设计容错控制律时为未知量;
式(1)中,其他参数或参数矩阵含义如下:
A,B分别为直升机姿态系统的状态矩阵和控制矩阵,通过四旋翼的系统辨识得到;ΔA为未知量,表示系统的参数不确定性,满足匹配条件ΔA=BN(t),N(t)未知但有上界,即存在未知参数l*,使得||N(t)||≤l*;Bω∈Rn×m为未知量,表示干扰信号的参数矩阵,满足匹配条件Bω=BF,F已知且有上界,即||F||≤λf;
步骤2、使用软件实现干扰与故障注入,通过对输出电压的调整,模拟执行器部分损失故障;故障模式需分别满足以下3个假设条件:
假设1:在任何故障模式下,{A,Bρ}均完全可控,即存在矩阵满足:
<mrow>
<mi>A</mi>
<mo>+</mo>
<msubsup>
<mi>B&rho;K</mi>
<mn>1</mn>
<mrow>
<mo>*</mo>
<mi>T</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>m</mi>
</msub>
</mrow>
且存在满足:
<mrow>
<msubsup>
<mi>B&rho;K</mi>
<mn>2</mn>
<mrow>
<mo>*</mo>
<mi>T</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msub>
<mi>B</mi>
<mi>m</mi>
</msub>
</mrow>
其中ρ表征执行器的部分失效程度;
假设2:外部干扰均分段连续且有界,即存在未知有界正常数满足:
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mo>&le;</mo>
<mover>
<mi>&omega;</mi>
<mo>&OverBar;</mo>
</mover>
<mo>;</mo>
</mrow>
假设3:在执行器失效故障模式下,执行器剩余执行能力可以保证控制目标得以实现,即并非所有执行器全部失效;
步骤3、通过数据采集卡中采集的状态信息和基于采集信息以及参考信息而计算出的误差信息,利用自适应控制方法和主动容错控制方法设计具有主动容错能力的直接自适应容错控制律,即四旋翼姿态容错控制器,并将容错控制律实时输出至数据采集卡中,经功率放大器放大信号幅值,将此反馈控制信号传输给旋翼驱动电机执行;
其特征在于,步骤3中直接自适应容错控制律具体步骤如下:
首先确定四旋翼姿态控制系统(1)跟踪的参考系统:参考输入信号r(t)由matlab软件发出指令得到,需设计参考系统的状态矩阵Am∈Rn×n和控制矩阵Bm∈Rn×l,使得系统满足响应快、稳定性好的性能指标,并得到参考状态xm(t),参考系统的表达形式如下:
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>A</mi>
<mi>m</mi>
</msub>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>B</mi>
<mi>m</mi>
</msub>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
为满足性能指标,设计Am,使其所有特征根均位于复平面的左半轴,且r(t)∈Rl,满足一致连续且有界;
四旋翼姿态自适应容错控制器设计时所需的输入由状态信号x(t)及状态跟踪误差信号e(t)组成,均从式(1)中获得,其中状态信号x(t)由系统的俯仰、滚转、偏航角大小和速度构成,通过角度、角速度陀螺仪分别测得,并从四旋翼的数据采集卡中解码得到;误差信号e(t)由参考模型中的状态量参考值xm(t)与上述状态信息x(t)相减得到,由此输入,设计直接自适应容错控制律的如下:
u(t)=K1 Tx(t)+K2 Tr(t)+(K3+K4)e(t) (7)
其中,u(t)为四旋翼直升机姿态控制系统的控制器输出信号,即功率放大器的输入信号;r(t)为参考系统的输入信号;
式(7)中,其他参数或参数矩阵含义如下:
K1 T=[k11,k12,...,k1m]T,K2 T=[k21,k21,...,k2m]T分别为系统状态x(t)和参考输入r(t)的反馈矩阵,用来对系统发生的部分失效故障进行容错控制,并保证直升机的姿态角有界跟踪参考状态xm(t);K3,K4为误差反馈矩阵,分别用来抵消外部干扰和参数不确定性对系统的影响;
由假设2可知则存在正常数l1 *满足以下不等式
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>F</mi>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mo>&le;</mo>
<mo>|</mo>
<mo>|</mo>
<mi>F</mi>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mo>|</mo>
<mi>&omega;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
<mo>&le;</mo>
<mo>|</mo>
<mo>|</mo>
<mi>F</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>&omega;</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&le;</mo>
<msubsup>
<mi>&mu;l</mi>
<mn>1</mn>
<mo>*</mo>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
定义参数如下:
<mrow>
<msubsup>
<mi>l</mi>
<mn>2</mn>
<mo>*</mo>
</msubsup>
<mo>=</mo>
<mfrac>
<msup>
<mi>l</mi>
<mrow>
<mo>*</mo>
<mn>2</mn>
</mrow>
</msup>
<mi>&mu;</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
由假设3可知ρ≠0,则存在正常数μ使下式成立
||eTPBρBTPe||≥μ||eTPB||2 (10)
式(7)中u(t)中控制器参数K1 T,K2 T分别为假设条件中矩阵 的估计值,控制参数k1j,k2j的自适应律分别为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>k</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mover>
<mover>
<mi>k</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&Gamma;</mi>
<mrow>
<mn>1</mn>
<mi>j</mi>
</mrow>
</msub>
<mi>x</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>Pb</mi>
<mi>j</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>k</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>2</mn>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mover>
<mover>
<mi>k</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>2</mn>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&Gamma;</mi>
<mrow>
<mn>2</mn>
<mi>j</mi>
</mrow>
</msub>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>Pb</mi>
<mi>j</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
其中Γ1j∈Rn×n,Γ2j∈Rl×l为任意的常数矩阵,且满足
式(7)中u(t)中控制器参数K3、K4可设计为:
<mrow>
<msub>
<mi>K</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mrow>
<msubsup>
<mi>l</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<msup>
<mi>B</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
</mrow>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mi>B</mi>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>l</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mi>&delta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>K</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>&eta;l</mi>
<mn>2</mn>
</msub>
<msup>
<mi>B</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
式(12)、(13)中,l1、l2的自适应律分别为
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<mrow>
<msub>
<mi>dl</mi>
<mn>1</mn>
</msub>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&gamma;</mi>
<mn>3</mn>
</msub>
<mi>&delta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>l</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mn>2</mn>
<msub>
<mi>&gamma;</mi>
<mn>3</mn>
</msub>
<mo>|</mo>
<mo>|</mo>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mi>B</mi>
<mo>|</mo>
<mo>|</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mrow>
<msub>
<mi>dl</mi>
<mn>2</mn>
</msub>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&gamma;</mi>
<mn>4</mn>
</msub>
<mi>&delta;</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>l</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&gamma;</mi>
<mn>4</mn>
</msub>
<mi>&eta;</mi>
<mo>|</mo>
<mo>|</mo>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>P</mi>
<mi>B</mi>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
2
l1、l2分别为l1 *和l2 *的估计值,γ3和γ4均为一任意正常数,δ(t)∈R+为任意一个一致连续有界函数,并满足
<mrow>
<munder>
<mi>lim</mi>
<mrow>
<mi>t</mi>
<mo>&RightArrow;</mo>
<mi>&infin;</mi>
</mrow>
</munder>
<msubsup>
<mo>&Integral;</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mi>t</mi>
</msubsup>
<mi>&delta;</mi>
<mrow>
<mo>(</mo>
<mi>&tau;</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>&tau;</mi>
<mo>&le;</mo>
<mover>
<mi>&delta;</mi>
<mo>&OverBar;</mo>
</mover>
<mo><</mo>
<mi>&infin;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
式(12)、(13)中,P∈Rn×n,P=PT>0且对任意的常数矩阵Q∈Rn×n,Q=QT>0满足
<mrow>
<msup>
<msub>
<mi>A</mi>
<mi>m</mi>
</msub>
<mi>T</mi>
</msup>
<mi>P</mi>
<mo>+</mo>
<msub>
<mi>PA</mi>
<mi>m</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>&eta;</mi>
</mfrac>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mi>&epsiv;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<mi>Q</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,ε为一任意正常数;
所设计出的控制器输出信号u(t)由式(7)得到,其中的自适应参数K1 T、K2 T、K3和K4由式(11)-(13)获得,其中参数满足式(14)-(16)的要求;输出信号u(t)传输至四旋翼的数据采集卡中,并经过功率放大器,传送至四旋翼电机中执行动作,此过程循环反复,直至四旋翼直升机系统的参数不确定性、外部干扰以及执行器部分损失故障完全被补偿、系统状态跟踪参考模型状态为止。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410202218.5A CN104007663B (zh) | 2014-05-13 | 2014-05-13 | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410202218.5A CN104007663B (zh) | 2014-05-13 | 2014-05-13 | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104007663A CN104007663A (zh) | 2014-08-27 |
CN104007663B true CN104007663B (zh) | 2017-08-25 |
Family
ID=51368373
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410202218.5A Expired - Fee Related CN104007663B (zh) | 2014-05-13 | 2014-05-13 | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104007663B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104290919A (zh) * | 2014-09-25 | 2015-01-21 | 南京航空航天大学 | 一种四旋翼飞行器的直接自修复控制方法 |
CN104965515A (zh) * | 2015-06-12 | 2015-10-07 | 南京航空航天大学 | 一种基于自适应控制的螺旋桨无人靶机的姿态控制方法 |
CN104950900B (zh) * | 2015-06-23 | 2017-10-31 | 南京航空航天大学 | 卫星姿态控制系统执行器驱动符号不确定性的自适应补偿方法 |
CN104965414B (zh) * | 2015-06-30 | 2017-07-07 | 天津大学 | 针对四旋翼无人机执行器部分失效的容错控制方法 |
CN105045105B (zh) * | 2015-07-30 | 2018-03-02 | 南京航空航天大学 | 一种针对状态时滞的四旋翼直升机容错控制装置及方法 |
CN105867139B (zh) * | 2016-06-27 | 2018-08-14 | 北京理工大学 | 一种模型参考自适应的飞行器鲁棒控制方法 |
CN107797454B (zh) * | 2017-11-03 | 2019-12-03 | 南京航空航天大学 | 基于有限时间控制的多智能体系统协同容错控制方法 |
CN108981709B (zh) * | 2018-08-02 | 2021-09-21 | 南京航空航天大学 | 基于力矩模型辅助的四旋翼横滚角、俯仰角容错估计方法 |
CN109358504B (zh) * | 2018-10-24 | 2021-07-02 | 中北大学 | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 |
CN109856972B (zh) * | 2019-02-21 | 2020-03-17 | 南京航空航天大学 | 一种无人直升机鲁棒容错跟踪控制方法 |
CN110109352B (zh) * | 2019-04-11 | 2022-04-08 | 浙江工业大学 | 一种三自由度四旋翼飞行器的固定时间自适应姿态控制方法 |
CN111880410B (zh) * | 2020-08-11 | 2021-12-28 | 北京航空航天大学 | 一种针对电机故障的四旋翼无人机容错控制方法 |
CN112147897B (zh) * | 2020-09-28 | 2021-10-12 | 南京航空航天大学 | 离散不确定多时滞四旋翼系统的容错控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012014071A1 (en) * | 2010-07-30 | 2012-02-02 | Toyota Jidosha Kabushiki Kaisha | Model construction apparatus |
CN102854874A (zh) * | 2012-06-18 | 2013-01-02 | 南京航空航天大学 | 一种基于联合多观测器的故障诊断与容错控制装置及方法 |
CN103135553A (zh) * | 2013-01-21 | 2013-06-05 | 南京航空航天大学 | 四旋翼飞行器容错控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7103426B2 (en) * | 2003-01-28 | 2006-09-05 | Rosemount Analytical Inc. | Anticipatory high frequency noise compensation in a distributed process control system |
-
2014
- 2014-05-13 CN CN201410202218.5A patent/CN104007663B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012014071A1 (en) * | 2010-07-30 | 2012-02-02 | Toyota Jidosha Kabushiki Kaisha | Model construction apparatus |
CN102854874A (zh) * | 2012-06-18 | 2013-01-02 | 南京航空航天大学 | 一种基于联合多观测器的故障诊断与容错控制装置及方法 |
CN103135553A (zh) * | 2013-01-21 | 2013-06-05 | 南京航空航天大学 | 四旋翼飞行器容错控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104007663A (zh) | 2014-08-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104007663B (zh) | 一种含参数不确定性的四旋翼姿态自适应容错控制方法 | |
Molchanov et al. | Sim-to-(multi)-real: Transfer of low-level robust control policies to multiple quadrotors | |
CN109343369B (zh) | 一种基于非线性观测器的四旋翼容错控制器设计方法 | |
CN106527137B (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN104965414B (zh) | 针对四旋翼无人机执行器部分失效的容错控制方法 | |
CN104049638B (zh) | 执行器动态的飞行器姿态分散式容错控制系统 | |
CN105904461B (zh) | 一种基于径向基函数的神经网络自适应遥操作控制方法 | |
CN109947134B (zh) | 基于多无人机分布式控制的四旋翼无人机编队容错方法 | |
Patel et al. | Rapid turning at high-speed: Inspirations from the cheetah's tail | |
CN108445760A (zh) | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 | |
Ranjbaran et al. | Fault recovery of an under-actuated quadrotor aerial vehicle | |
JP2018083625A (ja) | エフェクタに影響を与える故障を受けるマルチコプタの制御された飛行 | |
CN103135553A (zh) | 四旋翼飞行器容错控制方法 | |
CN109597426A (zh) | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 | |
Zhang et al. | The quadrotor dynamic modeling and indoor target tracking control method | |
CN113342033B (zh) | 基于固定时间技术的固定翼无人机姿态同步容错控制方法 | |
da Cunha | Benchmark: Quadrotor Attitude Control. | |
CN108762069A (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
Adir et al. | Sliding mode control of a 4Y octorotor | |
Moghadam et al. | Actuator and sensor fault detection and diagnosis of quadrotor based on two-stage kalman filter | |
Al-Fetyani et al. | Design of an executable anfis-based control system to improve the attitude and altitude performances of a quadcopter drone | |
Jasim et al. | Iterative linear quadratic regulator control for quadrotors leader-follower formation flight | |
Avram et al. | Nonlinear adaptive control of quadrotor UAVs with run-time safety assurance | |
Gao et al. | Research of stability augmentation hybrid controller for quadrotor UAV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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: 20170825 Termination date: 20210513 |
|
CF01 | Termination of patent right due to non-payment of annual fee |