一种用于无人机蜂群协同导航的完好性保护水平优化方法技术

技术编号:24329796 阅读:17 留言:0更新日期:2020-05-29 19:13
本发明专利技术公开了一种用于无人机蜂群协同导航的完好性保护水平优化方法,利用无人机蜂群协同信息辅助进行完好性保护水平优化;结合各卫星导航系统与协同辅助信息测量特性的差异,建立协同辅助信息的观测模型导航完好性保护水平计算方法,并通过多种导航模式之间的自动切换,有效利用协同辅助信息实现完好性保护水平的优化。该方法能够有效提高无人机蜂群协同导航的可靠性。

【技术实现步骤摘要】
一种用于无人机蜂群协同导航的完好性保护水平优化方法
本专利技术属于导航
,尤其涉及一种用于无人机蜂群协同导航的完好性保护水平优化方法。
技术介绍
在无人机蜂群导航过程中,可能出现仅依靠卫星导航系统提供的保护水平无法满足协同导航需求或者在特殊情况下无法获得足够的导航卫星的情况,此时卫星接收机无法检测和排除故障卫星,飞行器定位误差将增大,使无人机蜂群导航精度下降。协同导航技术利用多飞行器间的传感器信息,实现多飞行器间的信息协同,可辅助卫星导航接收机进行故障检测和排除。但是,在故障检测前,同样需要考虑卫星和飞行器共同构成的几何分布的影响,当几何条件不佳时,可能导致漏检。因此在故障检测之前,首先要判定卫星与飞行器共同构成几何条件是否满足故障检测的最大漏检率需求,保证飞行器信息辅助故障检测的可用性,给出系统的完好性保证。现有完好性方法通常适用于只采用卫星导航系统的情况,无法有效利用无人机蜂群成员之间协同信息来提高导航完好性水平,从而造成了协同辅助信息的浪费。如果直接应用完好性保护方法,也无法处理无人机蜂群协同辅助信息与卫星导航测量信息的差异特性,缺少对于多个成员协同辅助信息的处理方法,无法实现完好性水平的优化。
技术实现思路
专利技术目的:为解决现有技术存在协同辅助信息浪费、无法实现完好性水平的优化等问题,本专利技术提供了一种用于无人机蜂群协同导航的完好性保护水平优化方法。技术方案:本专利技术提供了一种用于无人机蜂群协同导航的完好性保护水平优化方法,包括如下步骤:步骤1:令当前时刻为t,以当前时刻无人机蜂群几何中心为原点,建立无人机蜂群中心坐标系;步骤2:无人机蜂群各成员根据自身的机载惯导系统,获取自身在地理坐标系下的位置矢量,并将其转换至无人机蜂群中心坐标系中;步骤3:无人机蜂群的n个成员分别通过自身的机载卫星导航接收机接收导航卫星信号,从而确定当前各自可用导航卫星的个数,并通过导航卫星星历获取当前时刻每个成员的所有可用导航卫星在地球固联直角坐标系的位置矢量,并将其转换至无人机蜂群中心坐标系中;步骤4:无人机蜂群的n个成员根据自身的自机载无线电协同通信范围,确定各成员的可用协同成员,得到各成员的可用协同成员集合;步骤5:计算每个成员的可用导航卫星数和可用协同成员数之和,根据每个成员的可用导航卫星数和可用协同成员数之和,判断每个成员机载导航系统的完好性保护是否可以用;针对任意一个成员k,k=1,2,3,…,n;若该成员的机载导航系统的完好性保护可用,则该成员的导航系统执行步骤6;若该成员的机载导航系统的完好性保护不可用,则将该成员完好性保护功能失效的信息输出至飞行管理系统,并将该成员从其它成员的可用协同成员集合中去除,同时该成员的导航系统执行步骤22;步骤6:对成员k进行辅助记录信息初始化,成员k当前辅助成员数量为ck,初始的ck=0,成员k当前辅助成员集合为Uk,Uk初始为空集;步骤7:对成员k进行观测模型初始化,成员k初始的观测模型表达式为:其中为成员k到其可用导航卫星中的第i个导航卫星的方向余弦,i=1,2,…,mk;其中mk为成员k的可用导航卫星的数量;初始的观测模型中ck=0;步骤8:对成员k进行权值变换矩阵初始化,则成员k初始的权值变换矩阵表达式为:其中,σs为导航卫星的伪距标准差,为mk维单位矩阵;初始的权值变换矩阵中ck=0;步骤9:计算成员k在当前辅助条件下导航故障检测门限TF,所述辅助条件包括:辅助成员的个数;步骤10:基于步骤9中的导航故障检测门限TF,计算当前辅助条件下成员k的非中心化参数λ;步骤11:计算成员k在当前辅助条件下的权重矩阵W,其表达式为:其中T为空间转置;步骤12:根据步骤11得到的权重矩阵W,计算得到矩阵参量A和C;步骤13:根据步骤10获得的非中心化参数λ和步骤12获得的矩阵参量A和C计算水平方向完好性保护水平lhor;步骤14:将lhor与预设好的水平定位告警限值ahor比较;若lhor≤ahor,则转步骤15,否则,转步骤17;步骤15:根据λ、矩阵A和矩阵C计算垂直方向完好性保护水平lver;步骤16:将lver与预设好的垂直定位告警限值aver比较;若lver≤aver,转步骤21;否则,转步骤17;步骤17:判断成员k的可用协同成员集合Ok是否为空集,若是,则进入协同完好性告警模式,同时将成员k从其它成员的可用协同成员集合中去除,并转至步骤22;否则执行步骤18;所述协同完好性告警模式为:将成员k完好性保护水平超限的信息输出至飞行管理系统;步骤18:对成员k进行辅助成员增选,成员k从其可用协同成员集合Ok中随机选择一个协同成员作为辅助成员,将其加入辅助成员集合Uk中,并在集合Ok中删除该成员;同时ck=ck+1;令选择的辅助成员编号为j,计算成员k的协同辅助观测矩阵gj;步骤19:成员k根据步骤18获得的协同辅助观测矩阵gj更新观测模型步骤20:成员k根据gj更新权值变换矩阵并转步骤11;步骤21:计算成员k的所有可用导航卫星中每个导航卫星的残差向量的验后权重误差,当某个导航卫星的验后权重误差大于预设好的检测限值时,认定该导航卫星存在故障,并将该导航卫星排除;步骤22:判断无人机是否着陆,若是,则停止计算;否则,t+1,且返回步骤1,整个无人机蜂群协同导航系统进行下一时刻机载导航系统完好性保护水平优化。进一步的,所述步骤5中根据每个成员的可用导航卫星数和可用协同成员数之和,判断每个成员机载导航系统的完好性保护是否可用,具体为:针对任意一个成员,若其可用导航卫星数和可用协同成员数之和大于an;则其机载导航系统的完好性保护可用,否则其机载导航系统的完好性保护不可用;所述an为预设好的阈值。进一步的,所述步骤10中计算当前辅助条件下成员k的非中心化参数λ的具体方法为:步骤10.1:设定λ初值为λ0=0,其循环步长为1,循环次数e初值为1,概率P初值为P0=1;步骤10.2:令λe=λe-1+1,其中,mk-4+ck为卡方分布的自由度,为非中心化卡方分布的概率分布函数;步骤10.3:将Pe与漏检率PMD作比较,若Pe≤PMD,则转步骤10.4;否则e+1;并转步骤10.2;步骤10.4:计算得到非中心化参数进一步的,所述步骤9中计算导航故障检测门限TF,具体为:其中为中心化卡方分布的概率分布函数的反函数,PFA为误警率,mk-4+ck为卡方分布的自由度。进一步的,所述步骤12中计算得到矩阵参量A和C,具体为:其中,diag表示提取矩阵对角线元素构成的新矩阵。进一步的,所述步骤13中计算水平方向完好性保护水平lhor,具体为:其中表示取矩阵对角线元素最大值;所述步骤15中计算垂直方向完好性保护水平lver,具体为:...

【技术保护点】
1.一种用于无人机蜂群协同导航的完好性保护水平优化方法,其特征在于,包括如下步骤:/n步骤1:令当前时刻为t,以当前时刻无人机蜂群几何中心为原点,建立无人机蜂群中心坐标系;/n步骤2:无人机蜂群各成员根据自身的机载惯导系统,获取自身在地理坐标系下的位置矢量,并将其转换至无人机蜂群中心坐标系中;/n步骤3:无人机蜂群的n个成员分别通过自身的机载卫星导航接收机接收导航卫星信号,从而确定当前各自可用导航卫星的个数,并通过导航卫星星历获取当前时刻每个成员的所有可用导航卫星在地球固联直角坐标系的位置矢量,并将其转换至无人机蜂群中心坐标系中;/n步骤4:无人机蜂群的n个成员根据自身的自机载无线电协同通信范围,确定各成员的可用协同成员,得到各成员的可用协同成员集合;/n步骤5:计算每个成员的可用导航卫星数和可用协同成员数之和,根据每个成员的可用导航卫星数和可用协同成员数之和,判断每个成员机载导航系统的完好性保护是否可用;针对任意一个成员k,k=1,2,3,…,n;若该成员的机载导航系统的完好性保护可用,则该成员的导航系统执行步骤6;若该成员的机载导航系统的完好性保护不可用,则将该成员完好性保护功能失效的信息输出至飞行管理系统,并将该成员从其它成员的可用协同成员集合中去除,同时该成员的导航系统执行步骤22;/n步骤6:对成员k进行辅助记录信息初始化,成员k当前辅助成员数量为c...

【技术特征摘要】
1.一种用于无人机蜂群协同导航的完好性保护水平优化方法,其特征在于,包括如下步骤:
步骤1:令当前时刻为t,以当前时刻无人机蜂群几何中心为原点,建立无人机蜂群中心坐标系;
步骤2:无人机蜂群各成员根据自身的机载惯导系统,获取自身在地理坐标系下的位置矢量,并将其转换至无人机蜂群中心坐标系中;
步骤3:无人机蜂群的n个成员分别通过自身的机载卫星导航接收机接收导航卫星信号,从而确定当前各自可用导航卫星的个数,并通过导航卫星星历获取当前时刻每个成员的所有可用导航卫星在地球固联直角坐标系的位置矢量,并将其转换至无人机蜂群中心坐标系中;
步骤4:无人机蜂群的n个成员根据自身的自机载无线电协同通信范围,确定各成员的可用协同成员,得到各成员的可用协同成员集合;
步骤5:计算每个成员的可用导航卫星数和可用协同成员数之和,根据每个成员的可用导航卫星数和可用协同成员数之和,判断每个成员机载导航系统的完好性保护是否可用;针对任意一个成员k,k=1,2,3,…,n;若该成员的机载导航系统的完好性保护可用,则该成员的导航系统执行步骤6;若该成员的机载导航系统的完好性保护不可用,则将该成员完好性保护功能失效的信息输出至飞行管理系统,并将该成员从其它成员的可用协同成员集合中去除,同时该成员的导航系统执行步骤22;
步骤6:对成员k进行辅助记录信息初始化,成员k当前辅助成员数量为ck,初始的ck=0,成员k当前辅助成员集合为Uk,Uk初始为空集;
步骤7:对成员k进行观测模型初始化,成员k初始的观测模型表达式为:



其中为成员k到其可用导航卫星中的第i个导航卫星的方向余弦,i=1,2,…,mk;其中mk为成员k的可用导航卫星的数量;初始的观测模型中ck=0;
步骤8:对成员k进行权值变换矩阵初始化,则成员k初始的权值变换矩阵表达式为:



其中,σs为导航卫星的伪距标准差,为mk维单位矩阵;初始的权值变换矩阵中ck=0;
步骤9:计算成员k在当前辅助条件下导航故障检测门限TF,所述辅助条件包括:辅助成员的个数;
步骤10:基于步骤9中的导航故障检测门限TF,计算当前辅助条件下成员k的非中心化参数λ;
步骤11:计算成员k在当前辅助条件下的权重矩阵W,其表达式为:



其中T为空间转置;
步骤12:根据步骤11得到的权重矩阵W,计算得到矩阵参量A和C;
步骤13:根据步骤10获得的非中心化参数λ和步骤12获得的矩阵参量A和C计算水平方向完好性保护水平lhor;
步骤14:将lhor与预设好的水平定位告警限值ahor比较;若lhor≤ahor,则转步骤15,否则,转步骤17;
步骤15:根据λ、矩阵A和矩阵C计算垂直方向完好性保护水平lver;
步骤16:将lver与预设好的垂直定位告警限值aver比较;若lver≤aver,转步骤21;否则,转步骤17;
步骤17:判断成员k的可用协同成员集合Ok是否为空集,若是,则进入协同完好性告警模式,同时将成员k从其它成员的可用协同成员集合中去除,并转至步骤22;否则执行步骤18;所述协同完好性告警模式为:将成员k协同完好性超限的告警信息输出至飞行管理系统;
步骤18:对成员k进行辅助成员增选,成员k从其可用协同成员集合Ok中随机选择一个协同成员作为辅助成员,将其加入辅助成员集合Uk中,并在集合Ok中删除该成员;同时ck=ck+1;令选择的辅助成员编号为j,计算成员k的协同辅助观测矩阵gj;
步骤19:成员k根据步骤18获得的协同辅助观测矩阵gj更新观测模型
...

【专利技术属性】
技术研发人员:王融陈欣熊智刘建业赵伟陈明星杜君南赵耀康骏安竞轲聂庭宇
申请(专利权)人:南京航空航天大学
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1