指数平滑软卡方的低成本惯导组合导航方法

Low-cost inertial navigation method combining exponential smoothing and soft chi-square

  • 摘要: 针对低空复杂环境下卫星导航系统观测质量强非平稳、相邻历元突变易导致捷联惯性导航系统(strapdown inertial navigation system, SINS)/GNSS松组合定位解抖动与精度劣化的问题,本文提出一种基于指数平滑的序贯软卡方自适应量测加权方法以提升融合解的稳健性与精度. 该方法在误差状态卡尔曼滤波(error state Kalman filter, ESKF)框架内,基于归一化新息统计构造分量级一致性检验,并采用双阈值“软”调节机制对异常量测分量进行连续降权,避免硬剔除造成的信息损失;同时引入指数加权滑动平均(exponential weighted moving average, EWMA)对在线更新的量测协方差矩阵进行时间平滑,以抑制量测权重与滤波增益在异常区间的高频切换,从而降低解算振荡. 基于MPU6500-GNSS开源数据开展对比验证,结果表明所提方法能够显著削弱异常观测段引起的水平误差尖峰并改善轨迹恢复的平滑性:在11001800 s区间,东向误差均方根(root mean square, RMS)由19.303 m降至7.986 m、最大值由99.512 m降至55.325 m,三维定位误差模长RMS由19.411 m降至10.201 m、最大值由99.523 m降至63.223 m. 综上,所提方法在卫星导航系统观测质量突变工况下可有效抑制异常量测对融合解的破坏,显著提升低成本惯性测量单元(inertial measurement unit, IMU)/GNSS松组合定位精度与稳定性,并具备实现简洁、统计机理可解释的工程应用优势.

     

    Abstract: In low-altitude complex environments, GNSS observation quality is strongly non-stationary, and abrupt epoch-to-epoch changes can trigger pronounced solution jitter and accuracy degradation in loose-coupled strapdown inertial navigation system (SINS)/GNSS integration with low-cost sensors. To enhance robustness and positioning accuracy under such abrupt quality variations, an exponentially smoothed sequential soft chi-square adaptive measurement-weighting method is proposed. Within an error-state Kalman filter (ESKF) framework, component-wise normalized innovation statistics are constructed to perform consistency checking, and a dual-threshold soft regulation mechanism is employed to continuously down-weight abnormal measurement components, thereby avoiding information loss caused by hard rejection. Meanwhile, an exponentially weighted moving average is applied to the online-updated measurement covariance matrix, which suppresses high-frequency switching of measurement weights and filter gains in abnormal intervals and consequently reduces oscillatory behavior of the fused solution. Experiments conducted on an open-source MPU6500-GNSS dataset with pronounced GNSS fluctuations demonstrate that the proposed method significantly mitigates horizontal error spikes and improves trajectory smoothness. Over the 1100-1800 s interval, the root mean square (RMS) of the east-position error decreases from 19.303 m to 7.986 m and the maximum decreases from 99.512-55.325 m; the RMS of the 3D position-error norm decreases from 19.411-10.201 m and the maximum decreases from 99.523-63.223 m. The results indicate that the proposed scheme effectively limits the adverse impact of abrupt GNSS quality degradation, offering a simple, computationally light, and statistically interpretable strategy for stable and accurate low-cost inertial/GNSS positioning.

     

/

返回文章
返回