基于激光雷达与定位向量匹配的多无人机协同定位方法

摘要

本发明提供的基于激光雷达与定位向量匹配的多无人机协同定位方法，通过定位向量匹配算法，使用激光雷达测量无人机之间高精度的相对位置，以及使用GPS获取各无人机带有编号信息的低精度定位信息，将激光雷达定位信息和GPS定位信息融合，通过激光雷达定位向量和GPS定位向量匹配，解算出激光雷达所测无人机的编号，得到高精度的无人机协同定位信息，解决了激光雷达无法测得编队机群内部无人机编号的问题，计算出机群内部各无人机之间高精度的协同定位数据，满足无人机编队飞行对协同定位精度的要求。