基于多源信息自适应融合的无人机导航系统及方法

摘要

本发明提供了一种基于多源信息自适应融合的无人机导航系统及方法，其中的方法包括利用多个传感器检测无人机多个参考位置信息；计算每个传感器检测的参考位置信息与估计位置信息之间的差值，得到位置误差。针对同一方向对应有多个传感器的情况，自适应分配出该方向上每个传感器的信息融合权重，对每个传感器在该方向上的位置误差按照权重进行加权求和得到该方向上的位置总误差；基于位置误差或位置总误差，利用速度‑位移预测模型和三阶锁相环滤波器计算当前时刻估计的速度信息及估计位置信息。该方法既能够快速准确地从外部多源位置信息中估计出最优位置和速度，同时又减少了单个传感器信息突变带来的定位误差，提升了无人机跟踪的精确性。