基于测距/测速信息的无人机协同导航算法研究

为了提高无人机编队的导航精度,提出了一种基于测距/测速信息的主从式无人机协同导航算法。僚机通过机载数据链和相对导航设备分别获取长机导航信息和相对导航信息。建立了协同导航系统模型,推导了相对导航信息的坐标转换,利用卡尔曼滤波器对各无人机导航信息和相对导航信息进行融合,估计出各僚机惯导误差并进行仿真。仿真结果表明,该算法与现有的无人机协同导航算法相比,在位置和速度估计精度上都有明显提高。