利用道路约束提升车辆在无信号环境下的定位精度
Route-Constrained Robust Fusion Estimation for MEMS/GNSS Integrated Navigation of Unmanned Ground Vehicles in GNSS Degraded Environments

- 通过高精地图匹配历史轨迹与道路段,实现二维刚性变换定位
- 实验中最大偏差降低,隧道内定位连续性显著改善
- 适合复杂城市隧道等信号遮蔽场景的无人车导航
针对严重卫星信号遮蔽下无人地面车辆在结构化道路环境中累积定位漂移的问题,本文提出一种鲁棒的路线约束状态估计方法。在无卫星信号时段,该方法将历史推算轨迹与从高精地图提取的任务路线局部段进行匹配,通过二维刚性变换估计路网参考位置,并将其作为伪观测值融入扩展卡尔曼滤波更新。由此,道路级约束可持续注入统一的状态估计框架,有效抑制相对于任务路线的位置偏差,间接提升航向估计精度。为增强实用性,引入触发控制、匹配质量验证、路线偏移补偿及单次更新修正限制等工程策略。在长隧道、多段隧道和弯曲隧道三种典型场景下的实验表明,该方法能有效抑制信号中断期间误差累积,降低最大偏差风险,提升定位连续性与道路级可用性。
原文摘要 · Abstract (English)
To address cumulative localization drift of unmanned ground vehicles in structured road environments under severe Global Navigation Satellite System signal occlusion, this paper proposes a robust route-constrained state estimation method. During periods without satellite signals, the proposed method establishes the correspondence between the historical dead reckoning trajectory and local segments of the mission route extracted from a high-definition map, and estimates a route-referenced position via a two-dimensional rigid transformation. The estimated position is then formulated as a pseudo-position observation and incorporated into an Extended Kalman Filter update. In this way, route constraints at the road level can be continuously injected into a unified state estimation framework, thereby suppressing position deviation relative to the mission route while indirectly improving azimuth estimation. To enhance practical applicability, engineering strategies, such as trigger control, matching quality validation, route offset compensation, and single update correction limiting, are further introduced. Experiments in three representative scenarios, including a long tunnel, a multi-segment tunnel, and a curved tunnel, show that the proposed method effectively suppresses error accumulation during satellite outages, reduces the risk of large maximum deviation, and improves localization continuity and road-level usability.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。