动态观测权调整的GNSS/INS抗差因子图优化算法

A Robust Factor Graph Optimization Algorithm with Dynamic Observation Weight Adjusting

  • 摘要: 全球导航卫星系统(global navigation satellite system,GNSS)和惯性导航系统(inertial navigation system,INS)组合导航能够提供连续的定位服务,但在复杂的城市环境中,GNSS信号易受多路径效应和非视距信号的干扰,异常观测值频繁发生,显著影响组合导航的定位精度。针对传统因子图优化方法固定权重难以适应GNSS量测噪声协方差动态变化,而引入Huber核函数的抗差算法计算开销大的问题,提出了一种动态观测权调整的抗差因子图优化算法。该算法构建了动态权函数,根据窗口内的验后残差调整GNSS观测在目标函数中的残差权重系数,不对残差值进行非线性变换,保持了目标函数的二次形式。利用不同载体的自采数据和不同环境的开源数据进行实验验证,结果表明,相比基于Huber核函数的抗差算法,所提算法平均定位误差STD和RMS分别提升了约26%和12%,计算时间缩短了约18%。该算法在提升组合导航定位精度的同时优化了计算效率。此外,还利用开源数据分析了不同大小滑动窗口对所提算法抗差性能的影响,结果表明,当滑动窗口设置为30s时能够实现抗差效果与计算时间之间的平衡,所提抗差算法不会改变滑动窗口大小对定位及耗时的影响趋势。

     

    Abstract: Objectives: The integration of global navigation satellite systems (GNSS) and inertial navigation systems (INS) provides continuous positioning services. However, in complex urban environments, GNSS signals are highly susceptible to multipath effects and non-line-of-sight interference, which can severely degrade the positioning accuracy of integrated navigation systems. Traditional factor graph optimization methods with fixed weights struggle to accommodate the dynamic variability of GNSS measurement noise covariance, while robust algorithms employing the Huber kernel function incur significant computational overhead. Methods: A dynamic weight function-based robust factor graph optimization algorithm (FGO) is proposed, which dynamically adjusts the residual weight coefficients of GNSS observations in the objective function based on post-fit residuals within a sliding window. The algorithm preserves the quadratic form of the objective function by avoiding nonlinear transformations of residual values, ensuring computational efficiency and adaptability to varying observation quality. To process open-source data with the proposed robust algorithm, sliding windows of 10, 30, and 50 seconds were utilized. And analysis robust performance of the proposed algorithm in different size sliding windows. Results: Compared to the inclusion of the Huber kernel function, the inclusion of the dynamic weight function adjustment mechanism improves the average positioning error standard deviation and root mean square by 26% and 12% respectively When the sliding window is set to 30s, a satisfactory equilibrium between robustness and computation time can be attained. Conclusions: Experimental results show that: 1) compared to FGO with the addition of Huber kernel function, the dynamic weight function adjustment can effectively reduce the influence of GNSS outliers, and has positioning higher accuracy and robustness. 2) The proposed robust algorithm does not change the trend of the sliding window size on localization and time consumption.

     

/

返回文章
返回