基于分层中继节点的多海上无人系统的协同导航定位方法

本申请属于水下导航定位技术领域。本申请提供一种基于分层中继节点的多海上无人系统的协同导航定位方法。本公开实施例通过对从海上无人系统进行层级划分，利用改进的粒子群算法选取最优参考节点组合，得到第一层参考节点和第二层节点；根据第一层参考节点和第二层节点构建第一距离量测模型和第二距离量测模型，并结合宽带信号实现整体集群的中继节点通信网络构建；计算第一误差修正位置和第二误差修正位置，以实现海上无人系统集群的协同导航定位。可解决由于从海上无人系统数量增多造成主海上无人系统通信负担严重、通信网络连通性差、系统可观测性弱、集群位置信息利用率低引起从海上无人系统定位误差无法修正，集群协同导航定位失败等问题。