LiLoc通过动态融合多路数据实现长期精准定位,适合机器人持续导航场景。
LiLoc: Lifelong Localization using Adaptive Submap Joining and Egocentric Factor Graph
- 用自适应子图拼接生成中心会话先验,支持多会话鲁棒定位
- 引入全向因子图联合优化惯导、激光里程计与扫描匹配,提升定位精度
- 支持重定位与增量定位自动切换,适配不同导航需求
本文提出一种基于图结构的长期定位框架LiLoc,通过维护单一中央会话并利用多模态因子提升定位时效性与准确性。首先采用自适应子图拼接策略,为中央会话生成关键帧和位姿先验,并在子会话需要约束时提供支持;其次在全局坐标系中通过垂直识别与ICP精修实现子会话粗到细的位姿初始化。为提高后续定位精度,提出一种嵌入式因子图(EFG)模块,联合优化惯导预积分、激光里程计与扫描匹配因子。其中扫描匹配因子基于新型传播模型构建,将先验约束以边形式高效传递至相关位姿节点,权重由关键帧注册误差对应的噪声决定。此外,框架支持基于重叠度机制的模式切换:重定位模式(RLM)与增量定位模式(ILM),可灵活选择或更新中央会话中的先验子图。在公开与自建数据集上测试表明,该方法在定位精度上优于当前先进方法。代码将开源于https://github.com/Yixin-F/LiLoc。
原文摘要 · Abstract (English)
This paper proposes a versatile graph-based lifelong localization framework, LiLoc, which enhances its timeliness by maintaining a single central session while improves the accuracy through multi-modal factors between the central and subsidiary sessions. First, an adaptive submap joining strategy is employed to generate prior submaps (keyframes and poses) for the central session, and to provide priors for subsidiaries when constraints are needed for robust localization. Next, a coarse-to-fine pose initialization for subsidiary sessions is performed using vertical recognition and ICP refinement in the global coordinate frame. To elevate the accuracy of subsequent localization, we propose an egocentric factor graph (EFG) module that integrates the IMU preintegration, LiDAR odometry and scan match factors in a joint optimization manner. Specifically, the scan match factors are constructed by a novel propagation model that efficiently distributes the prior constrains as edges to the relevant prior pose nodes, weighted by noises based on keyframe registration errors. Additionally, the framework supports flexible switching between two modes: relocalization (RLM) and incremental localization (ILM) based on the proposed overlap-based mechanism to select or update the prior submaps from central session. The proposed LiLoc is tested on public and custom datasets, demonstrating accurate localization performance against state-of-the-art methods. Our codes will be publicly available on https://github.com/Yixin-F/LiLoc.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。