基于因子图的自主导航多源异构信息融合算法

摘要

为了解决惯性导航系统长航时累计误差和实时性问题,提出了一种基于因子图的多源信息融合算法。论文基于和积算法,采用了因子图模型进行基于最大后验概率的状态估计,计算变量的均值和方差完成数据融合,利用超宽带技术和视觉传感器对发生累积误差的惯性导航系统进行校准,完成误差修正。对信息融合算法进行了仿真,结果为:该算法各轴向的误差分别为0.36%和0.31%,解算时间为50 ms。该算法误差仅为惯性导航累计误差的1/3,实时性相较于其它算法更高。