Our new X account is live! Follow @wizwand_team for updates
WorkDL logo mark

Graph-Loc: Robust Graph-Based LiDAR Pose Tracking with Compact Structural Map Priors under Low Observability and Occlusion

About

Map-based LiDAR pose tracking is essential for long-term autonomous operation, where onboard map priors need be compact for scalable storage and fast retrieval, while online observations are often partial, repetitive, and heavily occluded. We propose Graph-Loc, a graph-based localization framework that tracks the platform pose against compact structural map priors represented as a lightweight point-line graph. Such priors can be constructed from heterogeneous sources commonly available in practice, including polygon outlines vectorized from occupancy/grid maps and CAD/model/floor-plan layouts. For each incoming LiDAR scan, Graph-Loc extracts sparse point and line primitives to form an observation graph, retrieves a pose-conditioned visible subgraph via LiDAR ray simulation, and performs scan-to-map association through unbalanced optimal transport with a local graph-context regularizer. The unbalanced formulation relaxes mass conservation, improving robustness to missing, spurious, and fragmented structures under occlusion. To enhance stability in low-observability segments, we estimate information anisotropy from the refinement normal matrix and defer updates along weakly constrained directions until sufficient constraints reappear. Experiments on public benchmarks, controlled stress tests, and real-world deployments demonstrate accurate and stable tracking with KB-level priors from heterogeneous map sources, including under geometrically degenerate and sustained occlusion and in the presence of gradual scene changes.

Wentao Zhao, Yihe Niu, Zikun Chen, Rui Li, Yanbo Wang, Tianchen Deng, Jingchuan Wang• 2026

Related benchmarks

TaskDatasetResultRank
Pose TrackingCMU-EXPLORATION 0 People
Max ATE (cm)14.78
6
Pose TrackingKITTI sequence 00-1
Map Size (MB)0.25
6
Pose TrackingKITTI sequence 00-2
Prior Map Size (MB)0.25
6
Pose TrackingKITTI sequence 00-3
Prior Map Size (MB)0.25
6
Pose TrackingKITTI sequence 05-1
Prior Map Size (MB)0.32
6
Pose TrackingKITTI sequence 05-2
Prior Map Size (MB)0.32
6
Pose TrackingERPoT (Sequence 01-1)
Prior Map Size (MB)0.87
6
Pose TrackingERPoT (Sequence 01-2)
Prior Map Size (MB)0.87
6
Pose TrackingERPoT (Sequence 02-1)
Prior Map Size (MB)0.56
6
Pose TrackingReal-world indoor site 0 People
Max ATE (cm)30.91
6
Showing 10 of 20 rows

Other info

Follow for update