CN113268084B - 一种无人机编队智能容错控制方法 - Google Patents
一种无人机编队智能容错控制方法 Download PDFInfo
- Publication number
- CN113268084B CN113268084B CN202110730693.XA CN202110730693A CN113268084B CN 113268084 B CN113268084 B CN 113268084B CN 202110730693 A CN202110730693 A CN 202110730693A CN 113268084 B CN113268084 B CN 113268084B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- fault
- sliding mode
- formation
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 41
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000013528 artificial neural network Methods 0.000 claims abstract description 15
- 210000001638 cerebellum Anatomy 0.000 claims abstract description 14
- 230000003044 adaptive effect Effects 0.000 claims abstract description 11
- 238000013459 approach Methods 0.000 claims abstract description 4
- 230000006870 function Effects 0.000 claims description 19
- 238000013461 design Methods 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 2
- 239000000654 additive Substances 0.000 claims description 2
- 230000000996 additive effect Effects 0.000 claims description 2
- 230000010354 integration Effects 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 230000002490 cerebral effect Effects 0.000 claims 2
- 241000764238 Isis Species 0.000 claims 1
- 230000006978 adaptation Effects 0.000 claims 1
- 238000012938 design process Methods 0.000 claims 1
- 238000004088 simulation Methods 0.000 abstract description 5
- 238000012795 verification Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 239000011197 carbon fiber sheet molding compound Substances 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000004913 activation Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开一种基于小脑模型神经网络和干扰观测器的非线性无人机编队的自适应分数阶滑模控制方法;为使无人机编队在执行任务时具有良好的跟踪性能,通过对无人机飞行实际情况的分析,并考虑了无人机编队受到执行器故障和外界电磁波干扰的影响;采用小脑模型神经网络逼近执行器偏置故障,以及利用扰动观测器估计并补偿未知外部干扰,设计了一种自适应分数阶滑模控制器;同时保证了所形成的闭环***在控制器作用下的全局稳定性,通过仿真实例验证了该方法具有一定的优势。
Description
技术领域
本发明涉及航空无人机控制领域,其具体涉及自适应无人机编队精确轨迹跟踪控制的问题。
背景技术
近年来,无人机控制技术已取得显著的进步,无人机编队被广泛应用于各个领域以完成复杂而艰巨的任务。特别是在一些高危工作或军事应用中发挥着巨大的作用,如山地侦察、电缆巡逻、军事救援等。因此,完成这些任务均存在一项需要解决的根本问题,即如何最高精度地实现无人机编队的轨迹跟踪控制。同时,无人机在复杂环境下编队运行存在一些***执行器故障以及外部干扰(气流、外部电磁波等)的问题,导致无人机轨迹偏移甚至发生碰撞。因此,采取先进控制器设计方法用于解此类问题具有实际意义。
专利CN110286694A发明了一种多领导者的分布式无人机编队协同控制方法,主要贡献为提出无人机在通信延迟环境下依旧实现一致的队形飞行的算法,但针对***存在的执行器故障和外部干扰的问题尚未解决。专利CN107807663A发明了一种基于自适应控制的无人机编队保持控制方法,针对受到未知外界扰动的无人机编队,将无人机的非线性模型基于小扰动原理线性化,不具有实际意义,针对普遍存在的执行器故障问题也尚未提供具体的解决办法。
目前,由于执行器故障和未知外部干扰等对非线性***的控制性能影响较大,国内外许多学者已经开展了此类问题的深入研究,证实干扰观测器可以很好地估计补偿未知干扰,神经网络逼近器用于近似补偿执行器故障也具有较好的效果,同时设计滑模控制器可保证闭环***全局范围内的稳定性、鲁棒性。此外,该方法在基于无人机编队控制的其他公开资料及文献未见有详细报道。
发明内容
鉴于上述现有技术中的不足,本发明提出基于小脑模型神经网络和干扰观测器的无人机编队自适应分数阶滑模控制方法,通过以下步骤组成:
步骤1、建立第i架无人机动力学模型,
其中,i=1,...,n表示第i架无人机,(xi,yi,zi)表示无人机在三维中三个方向的位移距离,Vi表示飞行速率,γi表示飞行航向角,χi表示飞行俯仰角。
其中,Ti为发动机推进力,Di和Li分别为飞行阻力和升力,mi为机身质量,g为重力加速度,φi倾斜角。
步骤2、将步骤1中的无人机动力学模型转化为状态空间方程,同时考虑***的偏置故障和未知干扰,无故障时引入外部干扰的非线性模型可描述为:
偏置故障发生时引入外部干扰的非线性模型可描述为:
其中Fi=[Ti,Lisinφi,Licosφi]T定义为***的控制输入,pi=[xi,yi,zi]T定义为无人机的空间位置,定义为无人机的空间速率,Dfi=[dfi1(t),...,dfin(t)]T表示偏置故障输入。若dfij(t)=0,则表示执行器正常工作。如果dfij(t)≠0,则表示执行器发生故障,dsi表示外界电磁波干扰项,其中:
εi=[0 0 g]T
步骤3、主要设计了干扰观测器,实现对未知干扰的有效估计补偿。具体过程如下:
考虑步骤2中无故障无人机状态方程,干扰观测器可设计为:
其中Zi∈R3,dsi∈R3,Pi(vi)∈R3是要设计的非线性向量值函数,Pi为正标量,设计为:
定义第i架无人机的观测误差为:
对其在[0,t]积分,得:
步骤4、设计一个自适应分数阶滑模控制器,利用小脑模型神经网络逼近器对偏置故障实现近似补偿。
首先说明***的实现需要无人机在编队机动过程中满足所要求的编队结构,第i架无人机的预定位置满足:
图论是编队飞行中非常重要的一部分,本发明采用无向图G=(v,E,A),v表示n个非空节点的集合,E为节点有序的边对的集合,邻接拉普拉斯矩阵A满足:
其中:
其中K11和K12为正对角矩阵,p1和q1为奇数,满足p1>q1>0。
对s1求导,得:
sat(s)是一个饱和函数,采用饱和函数代替理想滑动模态中的符号函数sgn(s)可用于削弱抖振现象,sat(s)表述为:
设计虚拟速率控制命令为:
其中k1和ξ1为正常数。
对s2求导,得:
从而得到无人机编队***自适应控制律为:
其中k2和ξ2为正常数。
接着,在已设计控制器基础上,开发了一种补偿控制输入Fd来逼近补偿执行器故障Df。因此,整个容错控制器可表示为:
F=F1+Fd
得到***的自适应补偿控制输入为:
小脑模型神经网络的结构体系包括输入空间、联想记忆空间、接收域空间、权重记忆空间和输出空间。本文采用高斯函数作为接受域基函数,表示为:
k=1,...,M
其中φik(si)为接受域对于第i个输入si在第k个块上的基函数,mik为均值,σik为方差,M表示块的数量,多维接收域表示为:
每个位置到一个特定可调值的权重内存空间中的N个分量可以表示为:
W=[w1,...,wk,...,wN]T
其中wk∈RM表示第k个接收域对应的权重值。权重值从零开始初始化,在线运行时自动调整。
输出是权值存储器中激活权值的代数和,表示为:
y=WTψ(s,m,σ)
根据神经网络的逼近原理,小脑模型可用于逼近故障Df:
其中ε为逼近误差,W*和ψ*为最优参数向量。通常,由于无法确定***所需的最优参数向量,因此设定估计函数为:
估计误差可定义为:
对于出现故障的无人机编队***,考虑小脑模型的自适应律为:
其中ρ1,ρ2,ρ3,ρ4为正常数,满足采用的自适应律能有效补偿加性故障Df,并保证***的有界稳定性。
步骤5、验证无人机编队***的闭环控制的稳定性。
根据所描述的无人机编队的滑模自适应控制方法,需证明无人机***状态和偏置故障以及干扰项估计误差的稳定性和信号的有界性;
选取李雅普诺夫函数V:
等效变换后不难得出:
若||si||≤||Δ||,得:
若||si||>||Δ||,得:
若||si||>||Δ||,得:
最终证得无人机***状态和故障逼近项以及干扰项估计误差一致有界,证明该闭环控制***实现了对无人机编队轨迹实现精确跟踪控制。
本发明同时考虑了执行器故障因素和未知外部扰动,采用的非线性模型比传统更符合无人机实际情况,所设计的自适应滑模控制方法更具优势。
附图说明
为更好地体现本发明所设计方法的优越性,针对执行器故障解决方案,选取了一种鲁棒容错控制策略结合整数阶滑模控制器(RISMC)与基于小脑模型神经网络的整数阶滑模控制器(CISMC)相比较,结果表明CISMC对执行器故障的逼近速率和精度均优于RISMC。此外,本发明所采用的分数阶滑模控制器(CFSMC)较整数阶滑模控制器(CISMC)动态性能更好,使无人机编队***具有更好的跟踪性能和较高的控制精度。
图1为基于小脑模型神经网络和扰动观测器的自适应分数阶滑模控制器结构框图
图2为x方向的跟踪误差仿真图
图3为y方向的跟踪误差仿真图
图4为z方向的跟踪误差仿真图
图5为CFSMC下的三维跟踪轨迹仿真图
具体实施方式
以下将结合附图及实施方式对本发明进一步详细地解释说明。此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
为了本领域人员可以更好地理解本发明的实施,本发明将运用Matlab软件进行无人机编队跟踪控制的仿真以验证其可靠性。我们考虑了四架无人机编队的情况。
无人机的质量分别取m1=1.5kg,m2=2kg,m3=1.8kg,m4=1.6kg。其中无人机受到的阻力表示为:
其中g=9.81kg/m2为重力,ρ=1.225kg/m3为空气密度,机翼面积S=1.37m2,CD0=0.02为零升力阻力系数,kd=0.1为感应阻力系数,kn=1为载荷因子有效性,Vwi为阵风,其模型可表示为:
四架无人机的初始位置和速度状态如表1所示:
无人机编号 | x/m | y/m | z/m | Vx(m/s) | Vy(m/s) | Vz(m/s) |
1 | -56 | 60 | 58 | 10 | 15 | 18 |
2 | -60 | 58 | 57 | 6 | 12 | 16 |
3 | -58 | -58 | 42 | 8 | 15 | 17 |
4 | 56 | 60 | 40 | 4 | 9 | 14 |
无人机编队中心的期望位置和速率表示为:
p1F(0)=[-20 -20 20]Tm
p2F(0)=[20 20 20]Tm
p3F(0)=[-20 -20 -20]Tm
p4F(0)=[20 20 -20]Tm
无人机编队中心的期望位置和速率表示为:
当无人机编队在所提出的控制器下编队飞行时,相应的加权邻接矩阵设计为:
同时,四架无人机距编队中心的位置均按照预定的队形设置完毕,在控制输入下进行协同运行,其中整个***控制输入F为:
F=F1+Fd
在满足闭环***稳定有界的前提下,控制器中的常量参数分别设定为:K11=diag(1.2,1.2,1.2,1.2),K12=diag(1.6,1.6,1.6,1.6),K21=K22=diag(1.8,1.8,1.8,1.8),k1=0.2,k2=0.4,ξ1=0.5,ξ2=0.7,α1=1.2,α2=1.5,p1=5,q1=3,p2=7,q2=5。饱和函数中的参数分别设定为:Δ=κ=0.1,ξ=4,λi=0.5。
外部干扰可模拟为:
执行器故障设计如下,当t≥25,偏置故障Df可表示为:
Db1=[4 2 3]T,
Db2=[2 3 3]T,
Db3=[4 3 3]T,
Db4=[3 2 4]T。
结果表明,CFSMC比CISMC具有更好的动态性能和控制精度,相较于鲁棒容错控制器,小脑模型神经网络对未知故障的补偿效果更好,通过上述仿真结果对比,验证了本发明提出的自适应分数阶滑模控制策略的有效性和可行性,符合预期。
最后说明,本发明未详细解释该领域技术人员公认常识,以上所述仅为本发明的一个具体实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种基于小脑模型神经网络和干扰观测器的非线性无人机编队的自适应分数阶滑模控制方法,由以下步骤组成:
步骤1、建立第i架无人机动力学模型,如下所示:
其中,i=1,...,n表示第i架无人机,(xi,yi,zi)表示无人机在三维中三个方向的位移距离,Vi表示飞行速率,γi表示飞行航向角,χi表示飞行俯仰角,分别为:
其中,Ti为发动机推进力,Di和Li分别为飞行阻力和升力,mi为机身质量,g为重力加速度,φi倾斜角;
无故障时引入外部干扰的非线性模型可描述为:
偏置故障发生时引入外部干扰的非线性模型可描述为:
其中Fi=[Ti,Lisinφi,Licosφi]T定义为***的控制输入,pi=[xi,yi,zi]T定义为无人机的空间位置,定义为无人机的空间速率,Dfi=[dfi1(t),...,dfin(t)]T表示偏置故障输入;若dfij(t)=0,则表示执行器正常工作;如果dfij(t)≠0,则表示执行器发生故障,dsi表示外界电磁波干扰项,其中:
εi=[0 0 g]T
步骤2、将步骤1中的无人机动力学模型转化为状态空间方程,同时考虑***的外部干扰和执行器偏置故障的建模;
步骤3、根据步骤2,在无偏置故障时设计一个干扰观测器来估计补偿未知外部干扰;
步骤4、设计了自适应分数阶滑模控制器,在偏置故障发生时,结合小脑模型神经网络设计一个补偿控制器来逼近偏置故障;
步骤5、验证无人机编队***的闭环控制的稳定性,需要证明无人机***状态和故障逼近项以及干扰项估计误差的稳定性:
选取李雅普诺夫函数V:
等效变换后不难得出:
若||si||≤||Δ||,得:
若||si||>||Δ||,得:
若||si||>||Δ||,得:
最终证得无人机***状态和故障逼近项以及干扰项估计误差一致有界,证明该闭环控制***实现了对无人机编队轨迹实现精确跟踪控制。
2.根据权利要求1所述一种基于小脑模型神经网络和干扰观测器的非线性无人机编队的自适应分数阶滑模控制方法,其特征在于,在无故障时干扰观测器的设计过程如下:
干扰观测器被设计用于补偿第i架无人机所受到的干扰,考虑步骤2中无故障无人机状态方程,干扰观测器可设计为:
其中Zi∈R3,dsi∈R3Pi(νi)∈R3是要设计的非线性向量值函数,Pi为正标量,设计为:
定义第i架无人机的观测误差为:
对其在[0,t]积分,得:
3.根据权利要求1所述一种基于小脑模型神经网络和干扰观测器的非线性无人机编队的自适应分数阶滑模控制方法,其特征在于,步骤4中自适应分数阶滑模控制器设计步骤如下:
其中K11和K12为正对角矩阵,p1和q1为奇数,满足p1>q1>0;
sat(s)是一个饱和函数,采用饱和函数代替理想滑动模态中的符号函数sgn(s)可用于削弱抖振现象,sat(s)表述为:
得到虚拟速率控制命令为:
其中k1和ξ1为正常数;
得到无人机编队***自适应控制律为:
其中k2和ξ2为正常数;
接着,在已设计控制器基础上,开发了一种补偿控制输入Fd来逼近补偿执行器故障Df,因此,整个容错控制器可表示为:
F=F1+Fd
得到***的自适应补偿控制输入为:
小脑模型神经网络的结构体系包括输入空间、联想记忆空间、接收域空间、权重记忆空间和输出空间,偏置故障的逼近误差为:
对于出现故障的无人机编队***,考虑小脑模型的自适应律为:
其中ρ1,ρ2,ρ3,ρ4为正常数,满足采用的自适应律能有效补偿加性故障Df,并保证***的有界稳定性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110730693.XA CN113268084B (zh) | 2021-06-29 | 2021-06-29 | 一种无人机编队智能容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110730693.XA CN113268084B (zh) | 2021-06-29 | 2021-06-29 | 一种无人机编队智能容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113268084A CN113268084A (zh) | 2021-08-17 |
CN113268084B true CN113268084B (zh) | 2022-10-04 |
Family
ID=77236086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110730693.XA Active CN113268084B (zh) | 2021-06-29 | 2021-06-29 | 一种无人机编队智能容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113268084B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114924588B (zh) * | 2022-05-31 | 2024-06-07 | 北京航空航天大学 | 一种无人机集群弹性安全编队方法 |
CN117008637A (zh) * | 2023-08-30 | 2023-11-07 | 南京航空航天大学 | 对蜂群无人机中故障无人机的容错控制方法 |
CN117177208B (zh) * | 2023-09-15 | 2024-04-26 | 南京航空航天大学 | 一种考虑随机通讯时延的集群无人机协同容错控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7454255B1 (en) * | 2003-12-09 | 2008-11-18 | Scientific Systems Company, Inc. | Methods and apparatus for safe, fault-tolerant control of complex technical systems |
CN104022742B (zh) * | 2014-06-19 | 2017-12-12 | 金陵科技学院 | 基于神经网络观测器的飞行器姿态鲁棒反演容错控制方法 |
CN106647288B (zh) * | 2017-02-23 | 2019-05-31 | 重庆邮电大学 | 基于非奇异终端滑模观测器的发动机指示扭矩估计方法 |
CN108845508B (zh) * | 2018-06-26 | 2021-03-30 | 长安大学 | 一种基于cmac-滑膜一体化控制的无人机半物理仿真控制方法 |
CN112327926B (zh) * | 2020-11-24 | 2023-07-21 | 南京工业大学 | 一种无人机编队的自适应滑模控制方法 |
-
2021
- 2021-06-29 CN CN202110730693.XA patent/CN113268084B/zh active Active
Non-Patent Citations (1)
Title |
---|
Integrated fault tolerant attitude control approach forsatellite attitude system with sensor faults;Moshu Qian etc.;《Optim Control Appl Meth.》;20201231;第555-570页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113268084A (zh) | 2021-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113268084B (zh) | 一种无人机编队智能容错控制方法 | |
CN110058519B (zh) | 一种基于快速自适应技术的主动编队容错控制方法 | |
CN107765553B (zh) | 针对旋翼无人机吊挂运输***的非线性控制方法 | |
CN110320925B (zh) | 基于高阶干扰观测器的四旋翼飞行器安全控制方法 | |
CN107390531B (zh) | 参数学习有限时间收敛的高超声速飞行器控制方法 | |
CN105159305A (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN113433955B (zh) | 有向切换拓扑下多auv编队队形一致性控制方法 | |
CN106707749B (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
CN105182990B (zh) | 具有输出受限的三自由度模型直升机的鲁棒控制方法 | |
CN112327926B (zh) | 一种无人机编队的自适应滑模控制方法 | |
CN115793453A (zh) | 融合ai深度学习的旋翼飞行器轨迹跟踪自适应控制方法 | |
CN105759609B (zh) | 一种基于显式非线性模型预测控制的舰载机自主着舰方法 | |
CN106842912A (zh) | 高超声速机动飞行抗舵面饱和鲁棒控制方法 | |
CN111273688A (zh) | 基于事件触发的四旋翼无人机一致性编队控制方法 | |
CN112631316B (zh) | 变负载四旋翼无人机的有限时间控制方法 | |
CN114815861A (zh) | 一种基于时空径向基函数神经网络的容错飞行控制方法 | |
CN105116905A (zh) | 一种飞行器姿态控制方法 | |
CN115129072A (zh) | 固定翼无人机位置跟踪偏差约束下终端滑模控制方法 | |
CN116360258A (zh) | 基于固定时间收敛的高超声速变形飞行器抗干扰控制方法 | |
CN114545979B (zh) | 一种基于强化学习的飞行器智能滑模编队控制方法 | |
CN116301007A (zh) | 基于强化学习的多四旋翼无人机集结型任务路径规划方法 | |
CN110109357A (zh) | 针对非标准型非线性航空器的半全局自适应控制方法 | |
CN112506209B (zh) | 一种基于自适应预测周期的再入飞行器预测控制方法 | |
CN115686036A (zh) | 一种基于预设性能的变外形飞行器多维复合控制方法 | |
Liu et al. | Optimal switching control for Morphing aircraft with Aerodynamic Uncertainty |
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 |