一种无人机集群多中心数据链相对导航一致初始化方法
属于集群协同导航与信息融合,具体地,涉及一种无人机集群多中心数据链相对导航一致初始化方法。
背景技术:
1、相对导航是无人机集群实现成员间位置关系确定和协同任务执行的重要技术。在无人机集群执行协同侦察、区域监视、灾害救援等任务过程中,当全球卫星导航系统可用时,各成员能够通过共享自身绝对导航结果,并结合成员间的位置关系计算得到机间相对位置。然而,在电磁干扰、信号遮蔽等卫星导航拒止环境下,各成员难以持续获得可靠的绝对位置信息,基于绝对导航结果共享的相对导航方式难以满足集群自主运行需求。
2、为提高卫星导航拒止环境下的自主导航能力,现有技术通常采用融合惯性导航信息与机间相对测距信息的数据链相对导航方法。该类方法通过惯性导航系统递推成员运动状态,并利用集群成员之间的数据链通信获取测距信息,结合滤波估计和多源信息融合算法,对成员之间的相对导航状态进行计算,以维持无人机集群内部的位置关系。进一步地,为提升相对导航估计能力,部分方法通过共享成员状态信息和相对量测信息,使各成员利用其他成员的观测结果进行协同估计,并通过联合状态建模维护成员之间的误差相关性。
3、随着无人机集群规模扩大以及任务区域、功能分工的动态变化,集群通常由多个局部作业单元组成,各作业单元在自身参考坐标系下进行相对导航,并由多个节点维护局部联合导航状态。当任务过程中出现成员加入、成员离开或者作业单元重新组合时,集群成员关系、通信拓扑以及滤波器中的状态维数均会发生变化,需要对新增成员进行初始化并重新建立与原有成员之间的导航状态关联。
4、然而,现有多中心相对导航方法通常基于固定成员集合和固定参考基准进行状态估计,在动态组网场景下仍存在不足。一方面,不同作业单元通常采用不同参考成员建立相对坐标系,各局部坐标基准之间存在差异,新增成员加入后无法直接利用不同参考基准下的状态信息进行融合,容易导致状态拼接过程中产生坐标不一致问题。另一方面,在卫星导航拒止环境下,新增成员的惯性导航位置存在累积漂移,若直接将该位置作为新增状态初始值,会使距离量测在偏离真实位置的状态点进行线性化,带来较大误差,影响滤波初始化过程。此外,新增成员的状态估计依赖于已有成员状态以及成员间相对量测信息,与原有成员状态之间存在误差相关性,若初始化过程中忽略该相关性,则难以保持联合滤波状态的一致性。
5、综上,现有技术中存在动态组网过程中不同参考坐标下成员状态难以统一、新增成员初始状态难以准确确定以及新增成员与原有成员之间状态相关性难以有效建立的缺陷。
技术实现思路
1、为解决现有技术中存在动态组网过程中不同参考坐标下成员状态难以统一、新增成员初始状态难以准确确定以及新增成员与原有成员之间状态相关性难以有效建立的缺陷,本发明提供的技术方案为:
2、一种无人机集群多中心数据链相对导航一致初始化方法,包括:
3、建立无人机集群中各节点的多中心相对导航联合误差状态模型,根据各节点自身导航状态信息以及所维护的其他节点导航状态信息构建联合误差状态向量,并根据各节点状态之间的关联关系建立对应的状态协方差的步骤;
4、检测无人机集群成员变化情况,根据变化前后的成员集合确定新增成员和离网成员,对离网成员对应的状态信息进行删除,对新增成员对应的状态信息进行增广,并对涉及新增成员的相对测量信息进行隔离处理,以形成待初始化成员对应的临时联合导航状态的步骤;
5、基于预设公共参考成员建立统一二维辅助公共坐标,将各节点的水平位置信息转换至所述统一辅助公共坐标下,并通过数据链共享各节点的导航状态信息、辅助公共坐标估计信息及对应的协方差信息,形成用于新增成员初始化的共享数据的步骤;
6、获取新增成员对应的共享数据以及成员间距离测量信息,在各节点利用高度计实现高度闭环后,根据所述共享数据、闭环高度差和所述距离测量信息建立新增成员二维位置约束关系,并基于所述位置约束关系确定新增成员相对于所述公共参考成员的初始二维位置修正量及对应协方差的步骤;
7、基于所述初始位置修正量、所述辅助公共坐标估计信息以及所述对应协方差构建动态组网伪量测关系,通过所述动态组网伪量测关系对新增成员与原有成员的联合导航状态进行更新,并建立新增成员状态与原有成员状态之间的互相关性的步骤;
8、根据新增成员初始化完成状态解除对应的测量隔离,使新增成员参与集群相对导航状态更新,并基于更新后的联合导航状态进行状态预测、量测更新以及误差反馈校正,输出无人机集群成员之间的相对导航结果的步骤。
9、进一步,在一个优选实施方式中,所述建立无人机集群中各节点的多中心相对导航联合误差状态模型,包括根据各节点自身导航误差状态以及所维护的其他节点导航误差状态构建联合误差状态向量,并根据不同节点状态之间的误差关联关系构建状态协方差矩阵,所述状态协方差矩阵用于表征各节点导航状态之间的误差相关性。
10、进一步,在一个优选实施方式中,所述检测无人机集群成员变化情况,包括根据变化前后的稳定成员集合确定新增成员集合和离网成员集合;针对所述离网成员集合删除对应状态变量,并保留剩余成员状态之间的协方差关系;针对所述新增成员集合在原有联合导航状态中增加对应状态变量,并设置用于初始化过程的临时状态及临时协方差。
11、进一步,在一个优选实施方式中,所述建立统一二维辅助公共坐标,包括以预设公共参考成员作为坐标参考基准,根据各节点导航状态信息与所述公共参考成员之间的水平位置关系生成二维辅助公共坐标估计信息,并将所述辅助公共坐标估计信息与对应协方差信息通过数据链发送至待初始化成员。
12、进一步,在一个优选实施方式中,所述确定新增成员相对于所述公共参考成员的初始位置修正量,包括根据接收到的多个成员共享数据以及对应的距离测量信息建立距离约束关系,将新增成员的二维位置修正量作为待求参数,在高度闭环、广播坐标作为给定输入的定位近似下,根据所述距离约束关系及toa测距误差对应的权重信息对所述二维位置修正量进行带数值稳定项的gauss-newton迭代求解,并根据求解结果确定所述初始位置修正量及对应协方差。
13、进一步,在一个优选实施方式中,所述构建动态组网伪量测关系,包括根据新增成员的初始位置修正量与公共参考成员状态信息构建自机伪量测关系,以约束新增成员状态与公共参考成员状态之间的位置关系;根据原有成员共享的导航状态信息构建他机伪量测关系,以将原有成员状态信息与新增成员状态信息进行联合更新。
14、一种无人机集群多中心数据链相对导航一致初始化方法,包括:
15、建立无人机集群中各节点的多中心相对导航联合误差状态模型,根据各节点自身导航状态信息以及所维护的其他节点导航状态信息构建联合误差状态向量,并根据各节点状态之间的关联关系建立对应的状态协方差的模块;
16、检测无人机集群成员变化情况,根据变化前后的成员集合确定新增成员和离网成员,对离网成员对应的状态信息进行删除,对新增成员对应的状态信息进行增广,并对涉及新增成员的相对测量信息进行隔离处理,以形成待初始化成员对应的临时联合导航状态的模块;
17、基于预设公共参考成员建立统一二维辅助公共坐标,将各节点的水平位置信息转换至所述统一辅助公共坐标下,并通过数据链共享各节点的导航状态信息、辅助公共坐标估计信息及对应的协方差信息,形成用于新增成员初始化的共享数据的模块;
18、获取新增成员对应的共享数据以及成员间距离测量信息,在各节点利用高度计实现高度闭环后,根据所述共享数据、闭环高度差和所述距离测量信息建立新增成员二维位置约束关系,并基于所述位置约束关系确定新增成员相对于所述公共参考成员的初始二维位置修正量及对应协方差的模块;
19、基于所述初始位置修正量、所述辅助公共坐标估计信息以及所述对应协方差构建动态组网伪量测关系,通过所述动态组网伪量测关系对新增成员与原有成员的联合导航状态进行更新,并建立新增成员状态与原有成员状态之间的互相关性的模块;
20、根据新增成员初始化完成状态解除对应的测量隔离,使新增成员参与集群相对导航状态更新,并基于更新后的联合导航状态进行状态预测、量测更新以及误差反馈校正,输出无人机集群成员之间的相对导航结果的模块。
21、计算机存储介质,用于存储计算机程序,当所述计算机程序被计算机读取时,所述计算机执行所述的方法。
22、计算机,包括处理器和存储介质,当所述处理器读取所述存储介质中存储的计算机程序时,所述计算机执行所述的方法。
23、计算机程序产品,作为计算机程序,当所述计算机程序被执行时,实现所述的方法。
24、与现有技术相比,本发明提供的技术方案的有益之处在于:
25、本发明通过构建统一辅助公共坐标、基于数据链共享信息确定新增成员初始相对位置,并结合动态组网伪量测更新建立新增成员与原有成员之间的状态相关性,实现了动态组网过程中多中心相对导航状态的一致初始化,解决了不同参考坐标下状态信息难以统一、新增成员初始状态不准确以及新增成员加入后状态相关性难以建立的问题。
26、本发明通过引入包含公共参考成员误差的辅助公共坐标,将不同局部簇中的成员位置转换至统一坐标定义下,并利用公共参考成员信息构造成员间位置关系,使不同参考基准下的相对位置状态能够在同一坐标体系下进行表达,避免了因局部坐标基准差异导致的状态无法直接融合问题。
27、本发明通过基于数据链共享导航状态、辅助公共坐标估计及对应协方差,并结合多个成员的toa量测构造位置约束关系,利用迭代加权最小二乘方式求解新增成员的位置修正量,使新增成员能够基于已有成员量测信息获得相对于统一参考坐标的初始位置状态,避免直接采用存在漂移的惯性导航位置作为状态初值所导致的量测线性化偏差。
28、本发明通过在新增成员初始化过程中设置动态组网伪量测,并分别利用自机伪量测和他机伪量测将新增成员位置状态与原有成员状态进行联合更新,使新增成员的状态估计能够与原有成员导航状态建立互相关性,避免因忽略成员间误差关联导致的联合状态估计不一致问题。
29、本发明通过根据集群成员变化情况调整滤波器状态维数,对离网成员执行状态删减,对入网成员进行增广建模,并在初始化期间对涉及未初始化成员的普通量测进行隔离,使动态组网过程中滤波状态结构能够适应成员变化,同时避免未完成初始化的成员状态影响已有成员的相对导航估计。
30、本发明通过在完成初始化后解除量测隔离,并基于调整后的成员集合继续执行时间更新、量测更新以及误差反馈校正,使动态组网后的成员状态能够继续参与相对导航递推过程,保持集群相对导航状态的连续更新。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com