基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法技术

本发明专利技术公开了基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，该方法包括以下步骤：首先，基于合力计算球形簇集合每层无人机的加速度，并将计算所得结果作为卡尔曼滤波的初始值；然后，确定无人机在k时刻的状态矩阵、测量矩阵、状态转移矩阵、系统输入矩阵、系统的过程噪声矩阵、先验估计和先验估计的协方差矩阵；接着，计算卡尔曼增益、后验估计值和协方差矩阵；然后，将后验估计加速度带入虚拟力导向合力公式，动态调节虚拟力导向合力公式中的系数控制无人机移动到后验估计中最优加速度位置，并计算抖动范围均值；最后，不断计算更新抖动范围均值，使平均抖动范围随着时间趋于零，最终抖动消除。最终抖动消除。最终抖动消除。

【技术实现步骤摘要】
基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法


[0001]本专利技术属于无人机集群编队控制系统
，具体涉及基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法。

技术介绍

[0002]无人机集群，指借鉴自然界的自组织机制，使具备有限自主能力的多架无人机在没有集中指挥控制的情况下，通过相互间信息通信产生整体效应，实现较高程度的自主协作。编队技术是无人机集群协同的基础，指多个无人机甚至成千上百的无人机联合运动时，无人机之间保持固定或变化的几何形状，并适应周边环境约束，通过机间协调完成复杂任务。无人机编队技术中的无人机通过局部感知和对拓扑结构中的相互作用决定运动状态，使多个无人机对象共同构成集合以形成相互的自主协调。在其任务区域内飞行过程中的信息相互交汇可实现高强度的协作对抗，防止友机敌机发生碰撞。从而在少量人员干预情况下完成预期的任务目标。
[0003]在无人机集群编队控制中，基于一种虚拟力导向的方法对每个无人机节点计算出引力和斥力综合的合力，根据合力控制移动无人机的位置及其运动状态。设置斥力来控制相邻无人机之间的安全距离，而利用引力来引导整个集群系统的行为，满足“近距排斥，远距吸引”的原则。能保证集群中各无人机不发生碰撞，用于复杂环境下的避障问题和路径规划问题。通过平衡斥力和引力来控制每个无人机状态，建立一个稳定无人机集群编队。对每个无人机节点计算出引力和斥力综合的合力，根据合力控制移动无人机的位置及其运动状态。当引力和斥力均衡时，每个无人机都应处于平衡状态。
[0004]在三维坐标下，无人机在引力与斥力表达均衡情况下，形成一个球形的簇集合，但可能存在簇内成员并非静止的情况，每架无人机在很小的球形坐标范围内位移抖动，范围幅度由外向内，导致平均抖动范围随着时间逐渐趋于一个常数，且位移抖动将一直存在，影响工作能力。这是目前基于虚拟力导向无人机集群编队控制方法需要解决的问题。

技术实现思路

[0005]本专利技术的目的在于提供一种基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，解决基于虚拟力导向无人机集群编队时产生的位移抖动问题。
[0006]为实现上述目的，本专利技术提供以下技术方案：基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，包括以下步骤：
[0007]S1将无人机编队节点放入三维坐标内形成一个球形的簇集合，在球形簇中根据半径进行层级划分，同一层内的无人机加速度相同且离中心节点越远加速度越大，每架无人机在时间t内抖动范围为Δ＝αt，其中α为加速度；确定无人机的抖动合集Δ＝{Δ0,Δ1,...Δ
i
...,Δ
N
}，N为无人机节点总数，计算平均抖动范围为
[0008]S2对无人机集群编队中的每个无人机节点计算出引力和斥力综合的合力得到虚拟力导向合力公式：
[0009]F
合
＝γ
×
F
引
+λ
×
F
斥
，
[0010]其中，γ表示引力调节系数，λ表示斥力调节系数；
[0011]S3将无人机的运动速度和加速度作为初始值，建立卡尔曼滤波模型，对每层无人机加速度进行卡尔曼滤波得到球形簇中每层无人机的后验估计加速度，通过所述虚拟力导向合理公式动态选择引力调节系数和/或斥力调节系数来控制球形簇中每层无人机达到所述后验估计加速度值，并计算无人机平均抖动范围；不断利用卡尔曼滤波更新后验估计加速度并调整引力调节系数和/或斥力调节系数，直到平均抖动范围抖动消除。
[0012]进一步，所述S3包括以下步骤：
[0013]S31：基于合力计算球形簇集合每层无人机的加速度及速度，并将计算所得结果作为卡尔曼滤波的初始值；
[0014]S32：确定每层无人机在k时刻的状态矩阵、测量矩阵，并根据所述状态矩阵得到卡尔曼滤波的状态方程，根据所述状态方程确定先验估计和先验估计的协方差矩阵，并根据测量矩阵得到卡尔曼滤波测量方程；
[0015]S33：根据S32计算卡尔曼增益，确定后验估计值和更新误差协方差矩阵；
[0016]S34：将后验估计加速度带入虚拟力导向合力公式，动态调节虚拟力导向合力公式中的系数控制无人机移动到后验估计中最优加速度位置，并计算抖动范围均值；
[0017]S35：不断计算更新抖动范围均值，使平均抖动范围随着时间趋于零，最终抖动消除。
[0018]进一步，所述S1中当时间t趋近于无穷时，若ρ为常数，将观察到无人机抖动现象，并且抖动不会消除。
[0019]进一步，所述S32包括以下步骤：
[0020]S321：建立卡尔曼滤波模型，对每层无人机的加速度进行卡尔曼滤波；
[0021]设在第i层的无人机在k时刻的加速度为a
i
(k)，速度为v
i
(k)，得到k时刻的状态矩阵：
[0022]v1(k)＝v1(k
‑
1)+a1(k
‑
1)
×
t+w
1,1
(k
‑
1)
[0023]a1(k)＝u1(k)+w
1,2
(k
‑
1)
[0024][0025]v
M
(k)＝v
M
(k
‑
1)+a
M
(k
‑
1)
×
t+w
M,1
(k
‑
1)
[0026]a
M
(k)＝u
M
(k)+w
M,2
(k
‑
1)
[0027][0028]其中，u(k)为无人机k时刻产生的加速度，w(k)为其他因素产生的干扰加速度；
[0029]S322：测量第i层无人机在k时刻的加速度及速度作为测量方程的初始值，得到k时刻的测量矩阵：
[0030]z
1,1
＝v1(k)+r
1,1
(k)
[0031]z
1,2
＝a1(k)+r
1,2
(k)
[0032][0033]z
M,1
＝v
M
(k)+r
M,1
(k)
[0034]z
M,2
＝a
M
(k)+r
M,2
(k)；
[0035]其中，r
i,1
(k),r
i,2
(k)为测量噪声；
[0036]S323：根据S321得到卡尔曼滤波状态方程：
[0037][0038]X(k)＝A
·
X(k
‑
1)+U
i
(k)+W
i
(k
‑
1)；
[0039]其中，A为状态转移矩阵：U
i
(k)为系统输入本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，其特征在于：包括以下步骤：S1将无人机编队节点放入三维坐标内形成一个球形的簇集合，在球形簇中根据半径进行层级划分，同一层内的无人机加速度相同且离中心节点越远加速度越大，每架无人机在时间t内抖动范围为Δ＝αt，其中α为加速度；确定无人机的抖动合集Δ＝{Δ0,Δ1,...Δ
i
...,Δ
N
}，N为无人机节点总数，计算平均抖动范围为S2对无人机集群编队中的每个无人机节点计算出引力和斥力综合的合力得到虚拟力导向合力公式：F
合
＝γ
×
F
引
+λ
×
F
斥
，其中，γ表示引力调节系数，λ表示斥力调节系数；S3将无人机的运动速度和加速度作为初始值，建立卡尔曼滤波模型，对每层无人机加速度进行卡尔曼滤波得到球形簇中每层无人机的后验估计加速度，通过所述虚拟力导向合理公式动态选择引力调节系数和/或斥力调节系数来控制球形簇中每层无人机达到所述后验估计加速度值，并计算无人机平均抖动范围；不断利用卡尔曼滤波更新后验估计加速度并调整引力调节系数和/或斥力调节系数，直到平均抖动范围抖动消除。2.如权利要求1所述的基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，其特征在于，所述S3包括以下步骤：S31：基于合力计算球形簇集合每层无人机的加速度及速度，并将计算所得结果作为卡尔曼滤波的初始值；S32：确定每层无人机在k时刻的状态矩阵、测量矩阵，并根据所述状态矩阵得到卡尔曼滤波的状态方程，根据所述状态方程确定先验估计和先验估计的协方差矩阵，并根据测量矩阵得到卡尔曼滤波测量方程；S33：根据S32计算卡尔曼增益，确定后验估计值和更新误差协方差矩阵；S34：将后验估计加速度带入虚拟力导向合力公式，动态调节虚拟力导向合力公式中的系数控制无人机移动到后验估计中最优加速度位置，并计算抖动范围均值；S35：不断计算更新抖动范围均值，使平均抖动范围随着时间趋于零，最终抖动消除。3.如权利要求1所述的基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，其特征在于：所述S1中当时间t趋近于无穷时，若ρ为常数，将观察到无人机抖动现象，并且抖动不会消除。4.如权利要求2所述的基于卡尔曼滤波的虚拟力导向无人机编队抖动消除方法，...

【专利技术属性】
技术研发人员：李永刚，王颖，李龙江，张兴，裴二荣，
申请(专利权)人：重庆擎羚科技有限公司，
类型：发明
国别省市：