无人机（UAV）技术的发展使得无人机的市场需求急速上升。由于单个无人机的生存能力差，无法完成复杂的任务，所以多以无人机群的形式协同完成任务。定位技术作为无人机技术中的关键技术，引起了广泛关注。目前，多采用全球定位系统（GPS）对无人机进行定位。然而，仅采用GPS对无人机进行定位存在着较大的误差，尤其是在高度的测量上；并且，GPS作为一种视距（LOS）技术，极易因信号受到遮挡而导致无法定位。针对这一问题，西安电子科技大学的陈睿副教授团队联合新南威尔士大学张伟教授在IEEE Internet of Things Journal期刊上发表了题为“Distributed and Collaborative Localization for Swarming UAVs”的论文，首次提出了一种基于节点连通度的动态分簇方案，并首次提出了一种适用于无人机群的簇内协作定位算法，最后提出了一种分簇缝合以及坐标转换方案。

　　如图1所示，在无人机群中，部分无人机因信号遮挡或者其他原因，无法收到卫星信号，从而无法通过搭载的 GPS 对自身进行定位。因此，需要通过其它无人机进行协同定位。

　　首先无人机群中的所有无人机均向邻居节点发送自己的序号（ID）以及连通度（DC）信息。其次，每个无人机比较已知DC和接收到的DC，更新自己最大DC并向周围邻居节点发送该信息。等到消息全部传输完成后，具有最大连通度的节点作为第一个簇头与其邻域共同构成第一个分簇。第二个簇头所划分的分簇需要与第一个分簇有至少四个公共节点，并且为了提高网络划分的效率，PG电子手机版避免划分多余的分簇，第二个分簇能够包含尽可能多的未划入分簇的节点。最后，不断选取下一个簇头形成分簇，直到无人机网络中的所有无人机均被划分到相应的簇中。如图2所示，以一个十四个节点组成的平面网络为例进行分簇。

　　当无人机网络完成分簇后，分簇内的所有无人机之间相互测距测角，并将测量得到的距离和角度发送给簇头无人机并计算向量矩阵。在稀疏连通的无人机网络中，只有部分无人机之间的测距和测角信息，那么簇头无人机将缺失元素置零，补全向量矩阵。通过SMDS算法计算分簇内每个无人机的相对坐标，为了降低SMDS算法复杂度并确保实时精确定位，提出通过 Nyström 近似分解子矩阵来代替分解整个矩阵以及幂法求取前三个最大特征值和对应的特征向量来代替特征值分解，大大降低复杂度同时定位性能仍与SMDS相当。算法计算复杂度比较如图3所示。

　　在计算得到各分簇无人机的相对坐标后，需要将各分簇进行缝合以得到全局坐标。利用第一分簇与第二分簇公共节点全局坐标以及第一分簇的相对坐标，采用 Procrustes 分析算法，得到第一分簇的全局坐标。更新集合中无人机的全局坐标，按照该方法不断将分簇缝合，直到确定所有无人机的全局坐标。分簇缝合示意图如图4所示。

　　当所有分簇均缝合完毕后，我们就得到了整个无人机网络的相对坐标，也即全局坐标。利用可用的GPS坐标以及所有无人机的全局坐标，采用Procrustes 分析算法进行坐标变换，即可得到无人机的绝对坐标。PG电子手机版为了满足三维空间中坐标转换条件，至少4架无人机GPS坐标可用。

　　①四种MDS算法定位误差与GPS配比关系：可以看出这四种基于 MDS 的定位算法均能有效提升GPS的定位精度且定位误差随GPS配比的增大而下降。SMDS-Ny 和 SMDS(P)-Ny-PM 算法的定位性能相当，且都明显优于 MDS-MAP和MDS-MAP(P)算法，这说明引入角度信息能够进一步提升定位精度，显示了角度信息的重要性。

　　②四种MDS算法定位误差与通信范围关系：可以看出这四种算法的定位误差均随着通信半径的增大而减小。SMDS-Ny 和SMDS(P)-Ny-PM 算法对通信半径的变化不太敏感。

　　③四种算法的定位误差与测距误差的关系：这四种算法的定位误差均随着测距误差的增大而增大，但定位性能仍然优于GPS。此外，引入角度信息的 SMDS-Ny和SMDS(P)-Ny-PM算法的定位性能优于仅基于测距的 MDS-MAP 和 MDS-MAP(P)算法，这说明引入的角度信息可以较好地补偿测距带来的误差。

　　④四种算法的定位误差与测角误差的关系：SMDS-Ny 和 SMDS(P)-Ny-PM 的定位误差均小于MDS-MAP 和 MDS-MAP(P)算法，并且当测角误差不超过8°时，引入角度信息时有助于提升定位性能的。

　　本文首次提出了一种基于SMDS无人机集群的分布式协同三维定位SMDS (P)算法和其低计算复杂度的 SMDS(P)-Ny-PM 算法，提高仅依靠GPS的无人机的定位精度和鲁棒性。相对于仅测距的MDS算法例如MDS-MAP和MDS-MAP (P)等，SMDS (P)-Ny-PM提高了定位精度，降低了SMDS计算复杂度。仿真结果表明，SMDS-Ny和SMDS (P)-Ny-PM对通信范围的敏感性较低，且均明显优于MDS-MAP和MDS-MAP (P)。此外，通过足够精确的AoA估计，所提出的SMDS (P)-Ny-PM算法优于其他基于MDS的协同定位算法，可以大大提高依赖GPS的无人机集群的定位精度和鲁棒性。

　　【智慧地球大讲堂】第205期：单光存，中国无人机遥感系统关键技术研发与应用

　　《慧天地》公众号聚焦国内外时空信息科技前沿、行业发展动态、跨界融合趋势，发现企业核心竞争力，传播测绘地理信息文化，为时空信息类相关专业学子提供日常学习、考研就业一站式服务，打造政产学研金服用精准对接的平台。