一种加权不确定性无人机集群协同导航方法技术

本发明专利技术公开了一种加权不确定性无人机集群协同导航方法，步骤为：S1、各无人机获得其当前时刻的信度信息S2、各无人机接收其它无人机广播的信度信息，并将其它无人机的信度信息转换为粒子集形式；S3、各无人机对其所接收到的信度信息的粒子集，求解出每个信度信息的权值，并进行归一化处理；S4、计算修正后的当前时刻计算位置；该方法结合惯性测量单元的动态误差统计特性来表征无人机动态位置误差与相关影响因素，可提升协同导航算法在无人机动态情况下的鲁棒性；针对各无人机位置误差实时变化的特点，将无人机协同导航过程中所接收的位置信息进行量化，并构建自适应权值调节函数，实现对无人机集群协同导航中各无人机位置信息的有效融合和修正。的有效融合和修正。的有效融合和修正。

【技术实现步骤摘要】
一种加权不确定性无人机集群协同导航方法


[0001]本专利技术涉及协同导航
，特别涉及一种加权不确定性无人机集群协同导航方法。

技术介绍

[0002]近年来，随着无人机技术的快速发展，在军事作战、地震救灾和农林植保等领域获得了广泛应用。单架无人机由于受自身动力、载荷和功能有限等方面的约束，难以单独执行复杂任务。而由一定数量无人机组成的集群系统，可在低成本基础上进一步提高整体载荷和感知能力，最大限度地发挥无人机的优势。
[0003]由卫星导航等无线电方式提供的精确位置信息是无人机集群进行分布式控制和编队的基础，但当无人机集群穿行于城市隧道、洞穴等卫星导航信号失效的环境时，无人机需依靠惯性导航设备获取导航信息。然而受制于惯性器件各类误差，惯性导航系统的位置误差随时间发散，导致无人机集群无法顺利遂行任务。协同导航技术通过无人机间精确测距测向和信息共享，采用特定算法实现个体位置信息的协同优化，能够提升独立个体的定位与导航性能，是集群完成复杂任务组织和精确协同配合的基础。
[0004]卫星导航拒止条件下的协同导航技术一般分为主从式和并行式两类，主从式一般需要集群中有携带高精度惯性导航系统的主节点无人机提供导航参考信息，实现对集群中其余无人机位置的校准。但对于主节点依赖较高，导致集群系统鲁棒性差。而并行式方法中不依赖特定无人机的定位精度，存在个别无人机故障或通信失败时仍可实现相互校正，保证集群中其余个体的准确定位。传统并行式协同导航算法直接将导航信息进行等权重融合，未考虑各无人机位置误差大小受到如惯性器件质量、无人机机动状态和丢失卫星导航信号时间等多种因素影响，导致协同导航精度提升效果有限。

技术实现思路

[0005]本专利技术的目的是提供一种解决在卫星导航信号丢失条件下无人机惯性导航系统误差随时间累计的问题的加权不确定性无人机集群协同导航方法。
[0006]为了解决上述问题，本专利技术提出一种基于加权置信传播的协同导航算法，在构建协同导航贝叶斯因子图模型的基础上，利用改进的置信传播算法完成因子图模型中的信息传递与融合，实现多个无人机的协同导航。
[0007]为此，本专利技术的具体技术方案如下：
[0008]一种加权不确定性无人机集群协同导航方法，其具体步骤如下：
[0009]1、一种加权不确定性无人机集群协同导航方法，其特征在于，步骤如下：
[0010]S1、各无人机根据自身惯性测量单元输出的位移量、角速率信息和加速度信息，获得其当前时刻的信度信息，包括无人机当前时刻计算位置和位置不确定性对角阵；
[0011]S2、各无人机接收其它无人机广播的信度信息，并将其它无人机的信度信息转换为粒子集形式；
[0012]对于任一架无人机i：
[0013]S201、无人机i接收其它无人机j广播的信度信息；
[0014]S202、将无人机j的当前时刻计算位置和位置不确定性对角阵作为正态分布中的参数，随机抽取M个粒子，构成计算位置粒子集其中，p为粒子的计算位置，w为粒子对应的权值，下标k表示粒子集内部的粒子编号；
[0015]S203、将无人机j到无人机i之间相对距离量测值和无人机j到无人机i之间相对距离量测的方差为作为正态分布中的参数，随机抽取M个粒子，构成距离粒子集其中，下标k表示粒子集内部的粒子编号，通过无人机携带的无线电测距设备测得，为无线电测距设备相关参数；
[0016]S204、按均匀分布(0,2π]随机抽取M个粒子，构成用于描述无人机j与无人机i之间相对角度的角度粒子集其中，下标k表示粒子集内部的粒子编号；
[0017]S205、基于步骤S202～步骤S204，无人机i接收到其余每架无人机j的信度信息的粒子集根据公式：计算得到；
[0018]S3、各无人机对其所接收到的信度信息的粒子集，求解出每个信度信息的权值，并进行归一化处理；
[0019]S301、无人机i根据接收的信度信息的粒子集计算其与各无人机j之间的位置信息的权值w
ij
(t)：
[0020][0021]式中，c为与惯性器件精度有关的参数，J
i
{p(t)}为无人机i的综合位置不确定性，其由无人机i的北向的位置不确定性矩阵E{δp
N
(t)}和东向的位置不确定性矩阵E{δp
E
(t)}计算得到，计算公式为：计算得到；J
j
{p(t)}为无人机j的综合位置不确定性，其由无人机j的北向的位置不确定性矩阵E{δp
N
(t)}和东向的位置不确定性矩阵E{δp
E
(t)}计算得到，计算公式为：计算得到；
[0022]S302、将全部信度信息的权值w
ij
(t)按照公式：进行归一化计算，得到归一化权值v
ij
(t)；其中，N为构成无人机集群的无人机数量。
[0023]S4、计算修正后的当前时刻计算位置；
[0024]S401、将无人机i接收到的信度信息接收信度信息的粒子集分别转化为概率密度函数
[0025][0026]式中，为高斯核，σ为测距信息的标准差，与分别为信度信息的粒子集中的粒子的位置和粒子的权值；
[0027]S402、将无人机i当前时刻计算位置转化为概率密度函数
[0028][0029]式中，与分别为无人机i当前时刻计算位置的粒子集内的粒子的位置和粒子的权值；
[0030]S403、将步骤S2得到的全部信度信息粒子集汇总并从中均匀采样，随机抽取500个粒子，得到代表无人机i位置分布的粒子集其中，为粒子的位置，为粒子的新权值，其计算公式为：
[0031][0032]式中，与分别为通过核密度估计得到的计算位置信息和接收信度信息的概率密度函数，表示无人机i接收到的全部信度信息粒子集的总和，表示无人机i所能接收到无人机j信度信息的集合；
[0033]S404、无人机i根据公式：求得位置的最小均方误差，即经过修正后的无人机i的当前时刻位置。
[0034]进一步地，步骤S1中，无人机的当前时刻的计算位置计算公式为：
[0035][0036]式中，下标i表示无人机编号，表示无人机上一时刻位置，f(Ω)为惯性导航系统输出的位移量，为无人机当前时刻计算位置。
[0037]进一步地，无人机位置不确定性对角阵U
(t)
的计算公式为：
[0038]U
(t)
＝diag{E{δp
N
(t)}E{δp
E
(t)}}，
[0039]式中，E{δp
N
(t)}为无人机的北向的位置不确定性矩阵E{δp
N
(t)}，E{δp
E
(t)}为无人机的东向的位置不确定性矩阵，二者通过无人机的惯性测量单元输出的角速率信息和加速度信息计算得到；其中，
[0040][0041][0042]式中，δK
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种加权不确定性无人机集群协同导航方法，其特征在于，步骤如下：S1、各无人机根据自身惯性测量单元输出的位移量、角速率信息和加速度信息，获得其当前时刻的信度信息，包括无人机当前时刻计算位置和位置不确定性对角阵；S2、各无人机接收其它无人机广播的信度信息，并将其它无人机的信度信息转换为粒子集形式；对于任一架无人机i：S201、无人机i接收其它无人机j广播的信度信息；S202、将无人机j的当前时刻计算位置和位置不确定性对角阵作为正态分布中的参数，随机抽取M个粒子，构成计算位置粒子集其中，p为粒子的计算位置，w为粒子对应的权值，下标k表示粒子集内部的粒子编号；S203、将无人机j到无人机i之间相对距离量测值和无人机j到无人机i之间相对距离量测的方差为作为正态分布中的参数，随机抽取M个粒子，构成距离粒子集其中，下标k表示粒子集内部的粒子编号，通过无人机携带的无线电测距设备测得，为无线电测距设备相关参数；S204、按均匀分布(0,2π]随机抽取M个粒子，构成用于描述无人机j与无人机i之间相对角度的角度粒子集其中，下标k表示粒子集内部的粒子编号；S205、基于步骤S202～步骤S204，无人机i接收到其余每架无人机j的信度信息的粒子集根据公式：计算得到；S3、各无人机对其所接收到的信度信息的粒子集，求解出每个信度信息的权值，并进行归一化处理；S301、无人机i根据接收的信度信息的粒子集计算其与各无人机j之间的位置信息的权值w
ij
(t)：式中，c为与惯性器件精度有关的参数，J
i
{p(t)}为无人机i的综合位置不确定性，其由无人机i的北向的位置不确定性矩阵E{δp
N
(t)}和东向的位置不确定性矩阵E{δp
E
(t)}计算得到，计算公式为：计算得到；J
j
{p(t)}为无人机j的综合位置不确定性，其由无人机j的北向的位置不确定性矩阵E{δp
N
(t)}和东向的位置不确定性矩阵E{δp
E
(t)}计算得到，计算公式为：计算得到；S302、将全部信度信息的权值w
ij
(t)按照公式：进行归一化计算，
得到归一化权值v
ij
(t)；其中，N为构成无人机集群的无人机数量。S4、计算修正后的当前时刻计算位置；S401、将无人机i接收到的信度信息接收信度信息的粒子集分别转化为概率密度函数S401、将无人机i接收到的信度信息接收信度信息的粒子集分别转化为概率密度函数式中，为高斯核，σ为测距信息的标准差，与分别为信度信息的粒子集中的粒子的位置和粒子的权值；S402、将无人机i当前时刻计算位置转化为概率密度函数转化为概率密度函数式中，与分别为无人机i当前时刻计算位置的粒子集内的粒子的位置和粒子的权值；S403、将步骤S2得到的全部信度信息粒子集汇总并从中均匀采样，随机抽取500个粒子，得到代表无人机i位置分布的粒子集...

【专利技术属性】
技术研发人员：蔡庆中，李健，杨功流，闻泽阳，陈天宇，牛浩飞，李辉，李晶，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：