摘要
针对传统图优化导航方法中传感器测量协方差不准确导致估计精度下降的问题,本文提出了一种自适应滤波协同图优化导航方法。首先,构建INS/GNSS/e-Compass组合导航系统的因子图模型;然后,利用测量方差自适应滤波对传感器测量信息进行预估,在滤波过程中更新相关传感器的测量协方差矩阵,并将预估结果作为变量节点加入因子图;最后,通过滑动窗口控制优化范围,对窗口内的变量节点进行非线性优化并输出最终的导航状态。仿真和实验结果表明,所提出的方法对传感器测量协方差的不匹配问题具有自适应性,能够在不同场景下实现高效可靠的导航定位。相比于传统图优化方法,该方法的定位精度提升了30%,计算效率提升了12%。
- 单位