1.本发明涉及导弹编队控制器设计,更特别地说,是在传统导弹自主编队协同制导控制系统中,增加了本发明设计的完全分布式鲁棒导弹编队协同控制器。
背景技术:
2.导弹(missile)通常由战斗部(弹头)、弹体结构系统、动力装置推进系统和制导系统等四部分组成。其中,导弹制导系统是按一定导引规律将导弹导向目标,控制其质心运动和绕质心运动以及飞行时间程序、指令信号、供电、配电等各种装置的总称。其作用是适时测量导弹相对目标的位置,确定导弹的飞行轨迹,控制导弹的飞行轨迹和飞行姿态,保证弹头(战斗部)准确命中目标。
3.导弹编队(missiles formation,mf)是指由不少于两枚以上导弹根据作战任务需要,在时间段按照一定协同规则执行任务的编队简称。导弹编队的动态任务是指在导弹编队执行任务过程中,根据编队综合作战效能最大原则,基于一定的战场态势信息和导弹编队状态,为编队中每一枚导弹分配一个或一组有序任务。基本的编队队形有纵队、横队、楔形队、菱形队。
4.导弹编队飞行控制系统(flight control systrm of maf,fcsm)是根据编队决策与管理系统所生成的编队优化指标和编队的队形要求,实时优化并形成队形控制与保持的指令,保证实现节点的避碰机动控制和高品质的编队队形的系统。导弹能够实现安全稳定的自主编队飞行并按照要求完成作战任务,在很大程度上取决于导弹之间对导航定位系统、传感器和探测器等信息获取系统得到的信息的互连互通互操作水平。
5.2015年9月第1版出版的《导弹自主编队协同制导控制技术》,作者吴森堂,第50页介绍了导弹自主编队协同制导控制系统的体系结构。参见图1所示,包括有信息获取系统、编队决策与管理系统、编队飞行控制系统、成员飞行控制系统和编队支撑网络系统。第55页介绍了导弹编队的队形控制功能是指在离入队管理模块调度下,遵从航路规划/协同制导指令,在规定的飞行过程中控制和保持编队队形按照要求稳定飞行,其功能结构如图2所示。
6.现有技术中,根据各导弹在编队中的信息交互方式不同,将导弹编队队形的控制策略分为以下两种:集中式(centralized)策略和分布式(distributed)策略。集中式策略的求解依赖于fcsm系统。但由于信息传递能力有限,特别是导弹数量较多时,解算时间较长,对实时解算造成一定的影响。分布式控制策略作为一种新的控制策略,能够使编队中各导弹自主地生成控制指令,而不是依赖于fcsm系统。然而对于所设计的分布式fcsm系统需要编队支撑网络系统的全局信息,故无法达到真正意义下的完全分布式导弹编队,由于导弹群(missile group)空间拓扑分布和信号传输距离有限,可能会导致导弹之间信息通讯不畅通,甚至可能使导弹坠毁,从而导致导弹编队作战任务失败。
技术实现要素:
7.为了解决导弹编队在大机动飞行过程中的编队控制,以及受到不确定性因素和外界环境干扰因素导致的不能保持编队队形稳定飞行的任务,本发明设计了一种完全分布式鲁棒导弹编队协同控制器。本发明控制器一方面采用在编队队形生成算法中设置新的导弹动态模型,另一方面在编队队形导引算法中设置新的导弹运动模型。本发明通过构建导弹编队在多种不确定干扰因素影响下的动力学模型,使多枚导弹在多种不确定性以及外界扰动情况下实现期望的稳定飞行。本发明控制器的输入指令与编队通信拓扑结构的全局信息无关,只依赖于导弹自身及其邻居的相对位置和速度。从而实现导弹编队在多种不确定干扰因素影响下的完全分布式编队飞行的技术效果。
8.本发明设计的一种完全分布式鲁棒导弹编队协同控制器,其特征在于:由完全分布式自适应控制器(100)、自适应补偿控制器(200)、控制指令融合模块(300)和导弹动态模型(400)组成:
9.完全分布式自适应控制器(100)第一方面接收成员飞行控制模块输出的领导者信息mis
领导者
和邻居导弹信息mis
邻居
;第二方面接收导弹状态信息mis
状态
;第三方面对mis
领导者
、mis
邻居
和mis
状态
进行完全分布式控制指令解析;第四方面将所述的输出给控制指令融合模块(300);
10.自适应补偿控制器(200)第一方面接收导弹状态信息mis
状态
;第二方面对mis
状态
进行拉普拉斯变换得到补偿控制指令解析;第三方面将所述的输出给控制指令融合模块(300);
11.控制指令融合模块(300)第一方面接收完全分布式控制指令和补偿控制指令第二方面对所述和所述求和,得到的运动控制输入指令u
i
;第三方面将所述的u
i
输出给导弹动态模型(400);
12.导弹动态模型(400)用于构建的任意一枚导弹i的动态模型为;
[0013][0014]
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上的飞行速度矢量,其模值为导弹i的飞行速度v
i
;
[0015]
表示确定的导弹飞行参数;
[0016]
u
i
表示编队飞行中导弹i的运动控制输入指令;
[0017]
表示确定的导弹飞行状态参数;
[0018]
表示不确定干扰因素造成的未知的导弹飞行参数;
[0019]
表示不确定干扰因素造成的未知的导弹飞行状态参数;
[0020]
dd
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到的外界干扰;
[0021]
完全分布式控制指令为:
[0022][0023][0024]
λ
i
表示时变的控制器权重参数;
[0025]
k
i
表示控制器反馈增益;
[0026]
pp
i
表示导弹群编队飞行的联合状态;
[0027]
aλ
i
表示时变权重参数的变化率;
[0028]
q
i
表示一个控制器增益;
[0029]
补偿控制指令为:
[0030][0031]
f
i
(s)=diag{af,bf,cf};
[0032][0033][0034][0035]
s表示拉普拉斯算子;
[0036]
f
i
(s)表示三个二阶滤波器形成的三乘三的对角矩阵;
[0037]
af表示第一个二阶滤波器;
[0038]
bf表示第二个二阶滤波器;
[0039]
cf表示第三个二阶滤波器;
[0040]
f
i,1
表示第一个二阶滤波器的增益参数;
[0041]
f
i,2
表示第二个二阶滤波器的增益参数;
[0042]
f
i,3
表示三个二阶滤波器的增益参数;
[0043]
运动控制输入指令u
i
为:
[0044]
u
i
=[tl
i
cosα
i (sl
i
tl
i
sinα
i
)cosφ
i (sl
i
tl
i
sinα
i
)sinφ
i
]
t
。
[0045]
本发明完全分布式鲁棒导弹编队协同控制器的优点在于:
[0046]
①
本发明的编队控制器采用完全分布式的方式使所有的控制器参数都与通信拓扑的全局信息无关,不需要通讯结构图的结构信息,它只依赖于自身及其邻居的相对位置和速度。这与不是完全分布式的传统技术是存在本质区别的,对于不是完全分布式的控制器需要整个系统的通讯矩阵,不能达到完全分布式,由于弹群空间分布和信号接收/发射器
的距离有限,可能会导致信息之间通讯不畅通,从而使弹群发生坠毁。
[0047]
②
本发明的控制器能够有效抑制导弹编队参数摄动、非线性动力学和外部时变扰动的影响,具有很好的鲁棒性。
[0048]
③
本发明设计的控制器充分利用编队动态方程中已知的非线性信息,降低鲁棒控制器设计的保守性。控制器结构简单,意义明确,工作时没有控制器的接入和断开的切换过程,易于实现。
附图说明
[0049]
图1是传统导弹自主编队协同制导控制系统的体系结构图。
[0050]
图2是传统导弹自主编队队形控制功能结构图。
[0051]
图3是本发明完全分布式鲁棒导弹编队协同控制器的结构图。
[0052]
图4是4枚导弹完全分布式协同编队飞行的示意图。
[0053]
图5a是导弹在地面坐标系e
地
‑
oxyz中所在位置的定义示意图。
[0054]
图5b是导弹在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中的姿态定义示意图。
[0055]
图6是本发明实施例中4枚导弹完全分布式编队飞行时的三维空间位置示意图。
[0056]
图7是本发明实施例中4枚导弹完全分布式编队飞行时的速度响应曲线。
[0057]
图8是本发明实施例中4枚导弹完全分布式编队飞行时的权重矩阵响应曲线。
[0058]
图9是本发明实施例中4枚导弹完全分布式编队飞行时的位置跟踪误差曲线。
具体实施方式
[0059]
下面将结合附图和实施例对本发明做进一步的详细说明。
[0060]
在本发明中,由于编队队形中的各个导弹在飞行任务过程中,导弹之间的协同制导与编队通信拓扑结构无关,即不需要通信拓扑的全局信息来制导各个导弹的飞行姿态,单个导弹只依赖于自身及其相邻导弹的相对位置和相对速度,因此,本发明设计的编队飞行控制系统是完全分布式的。因此,将一枚导弹标记为i,与导弹i相邻的导弹标记为导弹j、导弹ξ。例如,图4所示的4枚导弹组成的纵队编队队形,导弹i、导弹j、导弹ξ和导弹ζ。
[0061]
在本发明中,为了实现对导弹的姿态表征,应用了两个坐标系,一个是地面坐标系e
地
‑
oxyz,另一个为导弹i的弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
。
[0062]
如图5a所示的地面坐标系e
地
‑
oxyz的定义为:地面坐标系e
地
‑
oxyz与地球表面固连的坐标系,坐标系原点o选取在导弹发射点上,ox轴指向任意,冲着目标的方向为正方向,oy轴垂直于ox轴,oz轴与其它两轴垂直并构成右手坐标系。
[0063]
如图5b所示的弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的定义为:在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中o
b
在导弹的质心处(质心);x
b
轴在导弹对称平面内并平行于导弹的设计轴线指向机头;y
b
轴垂直于导弹对称平面指向机体右方;z
b
轴在导弹对称平面内,与x
b
轴垂直并指向弹体下方。弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
形成右手直角坐标系。
[0064]
在图5a中任意一导弹i在地面坐标系e
地
‑
oxyz中所在的位置,记为p
i
,且p
i
=[x
i
,y
i
,z
i
],其中:
[0065]
x
i
表示导弹i在地面坐标系e
地
‑
oxyz中x轴方向上的位置。
[0066]
y
i
表示导弹i在地面坐标系e
地
‑
oxyz中y轴方向上的位置。
[0067]
z
i
表示导弹i在地面坐标系e
地
‑
oxyz中z轴方向上的位置。
[0068]
在图5b中任意一导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中的姿态角包括有攻角α,航向角ψ,航迹角γ,倾侧角φ。
[0069]
航向角ψ是导弹纵轴ox
b
在水平面上的投影与地面坐标系ox轴间的夹角;
[0070]
攻角α是速度矢量在导弹纵向对称平面内的投影与导弹纵轴ox
b
之间的夹角;
[0071]
航迹角γ是导弹速度矢量与水平面间的夹角;
[0072]
倾侧角φ是导弹飞行时所旋转的角度。
[0073]
本发明旨在设计了一种完全分布式导弹编队协同控制器,该控制器内嵌在传统导弹自主编队协同制导控制系统中,即在传统导弹自主编队协同制导控制系统中增加了完全分布式导弹编队协同控制器。本发明完全分布式导弹编队协同控制器是由完全分布式自适应控制器100、自适应补偿控制器200、控制指令融合模块300和导弹动态模型400组成。其中:
[0074]
完全分布式自适应控制器100、自适应补偿控制器200和控制指令融合模块300与传统导弹自主编队协同制导控制系统中的容错控制模块对导弹编队进行并行处理。
[0075]
导弹动态模型400内嵌在传统导弹自主编队协同制导控制系统的编队队形生成算法中。
[0076]
导弹动态模型400
[0077]
传统导弹自主编队协同制导控制系统中对任意一枚导弹i的动态模型描述为:
[0078]
i为导弹的标识号。
[0079]
m
i
表示导弹i的质量。
[0080]
g表示引力常量。
[0081]
av
i
表示导弹i的飞行加速度;v
i
表示导弹i的飞行速度。
[0082]
aγ
i
表示导弹i的航迹角的角速度;γ
i
表示导弹i的航迹角。
[0083]
aψ
i
表示导弹i的航向角的角速度;ψ
i
表示导弹i的航向角。
[0084]
xv
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中x轴方向上的速度。
[0085]
yv
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中y轴方向上的速度。
[0086]
zv
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中z轴方向上的速度。
[0087]
α
i
表示导弹i的攻角。
[0088]
γ
i
表示导弹i的航迹角。
[0089]
φ
i
表示导弹i的倾侧角。
[0090]
ψ
i
表示导弹i的航向角。
[0091]
tl
i
表示导弹i的推力。
[0092]
zl
i
表示导弹i受到的阻力。所述ρ为大气密度,s
i
为导弹i横截面的参考面积,为导弹i的阻力系数。
[0093]
sl
i
表示导弹i的升力。所述导弹i的升力。所述为导弹i的升力系数。
[0094]
d
i,v
表示导弹i速度受到的外界干扰。
[0095]
d
i,γ
表示导弹i航迹角受到的外界干扰。
[0096]
d
i,ψ
表示导弹i航向角受到的外界干扰。
[0097]
d
i,x
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的x轴方向上受到的外界干扰。
[0098]
d
i,y
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的y轴方向上受到的外界干扰。
[0099]
d
i,z
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的z轴方向上受到的外界干扰。
[0100]
在本发明中,导弹i在地面坐标系e
地
‑
oxyz中的位置记为p
i
,且p
i
=[x
i
,y
i
,z
i
]。导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上的速度记为[xv
i
,yv
i
,zv
i
]。
[0101]
于是,结合传统导弹动态模型,得到适合本发明控制器的导弹i的运动模型为:
[0102]
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上的飞行速度矢量,其模值为v
i
。
[0103]
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上的飞行加速度矢量。
[0104]
u
i
表示编队飞行中导弹i的运动控制输入指令。
[0105]
b
i
表示导弹i的飞行参数矩阵。
[0106]
e
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到气动力作用下的加速度矢量。
[0107]
dd
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到的外界干扰。
[0108]
其中,
[0109][0110]
[0111][0112]
在编队飞行过程中,导弹参数会由于受到多种不确定干扰因素影响而具有不确定性,于是可以得到:
[0113][0114][0115]
表示确定的导弹飞行参数。
[0116]
表示不确定干扰因素造成的未知的导弹飞行参数。
[0117]
表示确定的导弹飞行状态参数。
[0118]
表示不确定干扰因素造成的未知的导弹飞行状态参数。
[0119]
在本发明中,分布式控制器参数与通信拓扑的全局信息无关,不需要通讯结构图的结构信息,它只依赖于导弹自身及其邻居导弹的相对位置和速度,设计的导弹i的动态模型描述为:
[0120][0121]
在本发明中,导弹i的位置记为p
i
=[x
i
,y
i
,z
i
],导弹j的位置记为p
j
(x
j
,y
j
,z
j
)。则导弹i与导弹j之间的位置偏差,记为δ
i,j
=[(x
i
‑
x
j
)(y
i
‑
y
j
)(z
i
‑
z
j
)]
t
,这个偏差决定了这群导弹的编队队形。
[0122]
完全分布式自适应控制器100
[0123]
参见图3所示,在本发明中,完全分布式自适应控制器100第一方面接收成员飞行控制模块输出的领导者信息mis
领导者
和邻居导弹信息mis
邻居
;第二方面接收导弹状态信息mis
状态
;第三方面对mis
领导者
、mis
邻居
和mis
状态
进行完全分布式控制指令解析;第四方面将所述的输出给控制指令融合模块300。
[0124]
在本发明中,所述完全分布式控制指令是用来抑制编队控制受到多种不确定干扰因素的影响。
[0125][0126][0127]
λ
i
表示时变的控制器权重参数。
[0128]
b
i
表示导弹i的飞行参数;且
[0129]
表示确定的导弹飞行参数。
[0130]
k
i
表示控制器反馈增益。
[0131]
pp
i
表示导弹群编队飞行的联合状态。pp
i
包含有领导者信息mis
领导者
和邻居导弹信息mis
邻居
。
[0132]
e
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到气动力作用下的加速度矢量;且
[0133]
表示确定的导弹飞行状态参数。
[0134]
aλ
i
表示时变权重参数的变化率。
[0135]
q
i
表示一个控制器增益。
[0136]
表示不确定干扰因素造成的未知的导弹飞行参数。
[0137]
表示不确定干扰因素造成的未知的导弹飞行状态参数。
[0138]
在本发明中,导弹i的飞行参数b
i
为:
[0139][0140]
在本发明中,导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到气动力作用下的加速度矢量e
i
为:
[0141][0142]
在本发明中,完全分布式自适应控制器100是用来实现期望的跟踪性能和实现完全分布式编队。
[0143]
m
i
表示导弹i的质量。
[0144]
g表示引力常量。
[0145]
γ
i
表示导弹i的航迹角。
[0146]
ψ
i
表示导弹i的航向角。
[0147]
zl
i
表示导弹i受到的阻力。所述ρ为大气密度,v
i
表示导弹i的飞行速度,s
i
为导弹i横截面的参考面积,为导弹i的阻力系数。
[0148]
自适应补偿控制器200
[0149]
参见图3所示,在本发明中,自适应补偿控制器200第一方面接收导弹状态信息mis
状态
;第二方面对mis
状态
进行拉普拉斯变换得到补偿控制指令解析;第三方面将所述的输出给控制指令融合模块300。
[0150][0151]
f
i
(s)=diag{af,bf,cf}
[0152][0153][0154][0155]
s表示拉普拉斯算子。
[0156]
f
i
(s)表示三个二阶滤波器形成的三乘三的对角矩阵。
[0157]
af表示第一个二阶滤波器。
[0158]
bf表示第二个二阶滤波器。
[0159]
cf表示第三个二阶滤波器。
[0160]
f
i,1
表示第一个二阶滤波器的增益参数。
[0161]
f
i,2
表示第二个二阶滤波器的增益参数。
[0162]
f
i,3
表示三个二阶滤波器的增益参数。
[0163]
在本发明中,三个二阶滤波器的结构是相同的。
[0164]
控制指令融合模块300
[0165]
参见图3所示,在本发明中,控制指令融合模块300第一方面接收完全分布式控制指令和补偿控制指令第二方面对所述和所述求和,得到的运动控制输入指令u
i
;第三方面将所述的u
i
输出给导弹动态模型400。
[0166][0167]
u
i
表示编队飞行中导弹i的运动控制输入指令。
[0168]
表示完全分布式自适应控制器输出的完全分布式控制指令。
[0169]
表示自适应补偿控制器输出的补偿控制指令。
[0170]
在本发明中,考虑导弹编队在多种不确定性外界干扰情况下,建立的导弹运动模型中的输入控制指令为:
[0171]
u
i
=[tl
i
cosα
i (sl
i
tl
i
sinα
i
)cosφ
i (sl
i
tl
i
sinα
i
)sinφ
i
]
t
[0172]
u
i
表示编队飞行中导弹i的运动控制输入指令。
[0173]
α
i
表示导弹i的攻角。
[0174]
φ
i
表示导弹i的倾侧角。
[0175]
上角标t为坐标转置符号。
[0176]
在本发明中,运动输入控制指令为一个三乘一的矩阵,所述tl
i
cosα
i
代表着导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的x轴方向上的控制指令,所述(sl
i
tl
i
sinα
i
)cosφ
i
代表着导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的y轴方向上的控制指令,所述(sl
i
tl
i
sinα
i
)sinφ
i
代表着导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
的z轴方向上的控制指令。
[0177]
验证
[0178]
针对导弹编队在完全分布式以及多种不确定性和干扰情况下,搭建matlab控制系统仿真。
[0179]
本发明通过运行于计算机中的计算机程序
‑‑‑‑
基于matlab(版本号2012a)平台进行仿真;matlab是一种用于算法开发、数据可视化、数据分析以及数值计算的高级技术计算语言和交互式环境。
[0180]
如图5所示的4枚导弹(导弹i、导弹j、导弹ξ和导弹ζ)编队飞行仿真,以验证本发明设计的完全分布式鲁棒导弹编队协同控制器的性能。飞行过程中,虚拟领导者的参考轨迹随飞行时间t记为p
虚拟领导者
=[240t 0t 60t]
t
。
[0181]
编队飞行中的4枚导弹的通讯结构选择如下:节点集合为{i,j,ξ,ζ},边界集合{(i,j),(i,ξ),(j,ζ)},导弹ζ作为有向图的根。在仿真中,导弹i遭受的周期性非消失的外部扰动选为:d
i,x
=10sin(t),d
i,y
=9sin(t),d
i,z
=8sin(t),d
i,v
=9sin(t),d
i,γ
=10sin(t),d
i,ψ
=8sin(t)。
[0182]
编队的初始条件设置如下:编队的初始条件设置如下:控制器参数选为:f
i,1
=50,f
i,2
=50,f
i,3
=50。
[0183]
仿真结果如图6、图7、图8、图9所示,图6是4枚导弹完全分布式编队飞行时的三维空间位置示意图,图7是4枚导弹完全分布式编队飞行时的速度响应曲线;图8是4枚导弹完全分布式编队飞行时的权重矩阵响应曲线,图8是4枚导弹完全分布式编队飞行时的位置跟踪误差曲线。从图6和图8可以看出,所设计的编队控制器是完全分布式的,所有的控制器参数都与通信拓扑的全局信息无关,不需要通讯结构图的结构信息,它只依赖于自身及其相邻导弹的相对位置和速度。此外,本发明的控制器能够有效抑制导弹编队参数摄动、非线性动力学和外部时变扰动的影响,具有很好的鲁棒性。从图9可以看出,编队的轨迹跟踪误差较小,能够满足导弹编队飞行控制精度要求,同时,能够实现快速、稳定地编队队形的形成和保持,大大提高导弹编队飞行的稳定性能。因此,所设计的控制器是十分有效的。
技术特征:
1.一种完全分布式鲁棒导弹编队协同控制器,其特征在于:由完全分布式自适应控制器(100)、自适应补偿控制器(200)、控制指令融合模块(300)和导弹动态模型(400)组成:完全分布式自适应控制器(100)第一方面接收成员飞行控制模块输出的领导者信息mis
领导者
和邻居导弹信息mis
邻居
;第二方面接收导弹状态信息mis
状态
;第三方面对mis
领导者
、mis
邻居
和mis
状态
进行完全分布式控制指令解析;第四方面将所述的输出给控制指令融合模块(300);自适应补偿控制器(200)第一方面接收导弹状态信息mis
状态
;第二方面对mis
状态
进行拉普拉斯变换得到补偿控制指令解析;第三方面将所述的输出给控制指令融合模块(300);控制指令融合模块(300)第一方面接收完全分布式控制指令和补偿控制指令第二方面对所述和所述求和,得到的运动控制输入指令u
i
;第三方面将所述的u
i
输出给导弹动态模型(400);导弹动态模型(400)用于构建的任意一枚导弹i的动态模型为;导弹动态模型(400)用于构建的任意一枚导弹i的动态模型为;表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上的飞行速度矢量,其模值为导弹i的飞行速度v
i
;表示确定的导弹飞行参数;u
i
表示编队飞行中导弹i的运动控制输入指令;表示确定的导弹飞行状态参数;表示不确定干扰因素造成的未知的导弹飞行参数;表示不确定干扰因素造成的未知的导弹飞行状态参数;dd
i
表示导弹i在弹体坐标系e
b
‑
o
b
x
b
y
b
z
b
中三个方向上受到的外界干扰;完全分布式控制指令为:aλ
i
=pp
it
q
i
pp
i
;λ
i
表示时变的控制器权重参数;k
i
表示控制器反馈增益;pp
i
表示导弹群编队飞行的联合状态;aλ
i
表示时变权重参数的变化率;q
i
表示一个控制器增益;
补偿控制指令为:f
i
(s)=diag{af,bf,cf};(s)=diag{af,bf,cf};(s)=diag{af,bf,cf};s表示拉普拉斯算子;f
i
(s)表示三个二阶滤波器形成的三乘三的对角矩阵;af表示第一个二阶滤波器;bf表示第二个二阶滤波器;cf表示第三个二阶滤波器;f
i,1
表示第一个二阶滤波器的增益参数;f
i,2
表示第二个二阶滤波器的增益参数;f
i,3
表示三个二阶滤波器的增益参数;运动控制输入指令u
i
为:u
i
=[tl
i
cosα
i (sl
i
tl
i
sinα
i
)cosφ
i (sl
i
tl
i
sinα
i
)sinφ
i
]
t
。2.根据权利要求1所述的完全分布式鲁棒导弹编队协同控制器,其特征在于:内嵌在传统导弹自主编队协同制导控制系统中。3.根据权利要求1所述的完全分布式鲁棒导弹编队协同控制器,其特征在于:控制器参数都与通信拓扑的全局信息无关,不需要通讯结构图的结构信息,它只依赖于自身及其相邻导弹的相对位置和速度,因此,所设计的编队控制器是完全分布式的。
技术总结
本发明公开了一种完全分布式鲁棒导弹编队协同控制器,其由完全分布式自适应控制器(100)、自适应补偿控制器(200)、控制指令融合模块(300)和导弹动态模型(400)组成。控制指令融合模块(300)对完全分布式控制指令和补偿控制指令求和,得到的运动控制输入指令u
技术研发人员:刘昊 刘德元 蔡国飙
受保护的技术使用者:北京航空航天大学
技术研发日:2021.03.02
技术公布日:2021/6/29
转载请注明原文地址:https://doc.8miu.com/read-3542.html