用轻量图结构地图实现强鲁棒的激光定位,尤其在遮挡和观测差时表现稳定。
Graph-Loc: Robust Graph-Based LiDAR Pose Tracking with Compact Structural Map Priors under Low Observability and Occlusion
- 构建点线混合图地图,融合多源地图数据生成紧凑先验
- 通过非平衡最优传输匹配扫描与地图,抗遮挡和碎片化干扰
- 动态调整更新方向,低可观测段保持稳定,适合真实复杂场景
基于地图的激光雷达位姿跟踪对长期自动驾驶至关重要。车载地图先验需紧凑以支持可扩展存储与快速检索,而在线观测常因部分、重复或严重遮挡导致信息不全。本文提出 Graph-Loc,一种基于图结构的地图定位框架,使用轻量级点线图表示紧凑的结构化地图先验。该先验可由实际中常见的异构数据构建,包括从占用/网格地图矢量化得到的多边形轮廓以及 CAD/模型/平面布局。对于每帧激光扫描,Graph-Loc 提取稀疏点与线特征形成观测图,通过激光射线模拟获取姿态相关的可见子图,并采用带局部图上下文正则项的非平衡最优传输进行扫描-地图匹配。非平衡形式放宽质量守恒,提升在遮挡下缺失、虚假及断裂结构的鲁棒性。为增强低可观测段的稳定性,从优化法向矩阵估计信息各向异性,并在约束弱的方向延后更新,直至约束充分恢复。在公开基准、受控压力测试与真实部署中验证,仅需千字节级先验,即可实现高精度稳定跟踪,适用于几何退化、持续遮挡及渐变场景变化。
原文摘要 · Abstract (English)
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.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。