Search papers, labs, and topics across Lattice.
This paper introduces a robust route-constrained state estimation method to mitigate cumulative localization drift in unmanned ground vehicles (UGVs) during GNSS signal outages. By correlating historical dead reckoning data with mission route segments from high-definition maps, the method estimates a route-referenced position using a two-dimensional rigid transformation and integrates this into an Extended Kalman Filter. Experimental results demonstrate significant improvements in localization accuracy and continuity, particularly in challenging environments like tunnels, reducing error accumulation and enhancing road-level usability.
Route constraints can dramatically enhance UGV localization accuracy in GNSS-degraded environments, reducing error accumulation by leveraging high-definition maps.
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.
