arXiv:2501.12764cs.RO2025-01中稿 · IROS 2024被引 2

提出高效算法,同步优化大环境下的全局地图与局部子图位姿。

Grid-based Submap Joining: An Efficient Algorithm for Simultaneously Optimizing Global Occupancy Map and Local Submap Frames

  • 基于网格子图拼接,将问题转化为非线性最小二乘求解。
  • 证明位姿增量与地图占用值无关,实现仅优化位姿的高效迭代。
  • 在大规模环境中显著提升效率和精度,适合实时机器人导航。

同时优化机器人位姿与地图可提升SLAM精度。但对无特征的2D SLAM方法,直接优化全部位姿与整张地图会极大增加计算开销,难以应对大规模环境。为此,本文提出基于网格的子图拼接方法,将2D网格子图拼接问题建模为非线性最小二乘(NLLS)形式,以同时优化全局占据地图与局部子图位姿。我们证明,在使用高斯-牛顿(GN)法求解时,每轮迭代中各位姿增量独立于全局占据地图的占用值。基于此性质,提出一种等效于完整GN法的位姿仅优化算法。该方法因位姿独立性和仅优化位姿而极为高效。仿真及公开2D激光数据集评估表明,相比现有最优方法,本方法在效率、精度上均表现更优,并能有效解决超大规模环境下的网格化SLAM问题。

原文摘要 · Abstract (English)

Optimizing robot poses and the map simultaneously has been shown to provide more accurate SLAM results. However, for non-feature based SLAM approaches, directly optimizing all the robot poses and the whole map will greatly increase the computational cost, making SLAM problems difficult to solve in large-scale environments. To solve the 2D non-feature based SLAM problem in large-scale environments more accurately and efficiently, we propose the grid-based submap joining method. Specifically, we first formulate the 2D grid-based submap joining problem as a non-linear least squares (NLLS) form to optimize the global occupancy map and local submap frames simultaneously. We then prove that in solving the NLLS problem using Gauss-Newton (GN) method, the increments of the poses in each iteration are independent of the occupancy values of the global occupancy map. Based on this property, we propose a poseonly GN algorithm equivalent to full GN method to solve the NLLS problem. The proposed submap joining algorithm is very efficient due to the independent property and the pose-only solution. Evaluations using simulations and publicly available practical 2D laser datasets confirm the outperformance of our proposed method compared to the state-of-the-art methods in terms of efficiency and accuracy, as well as the ability to solve the grid-based SLAM problem in very large-scale environments.

SLAM网格地图优化算法机器人

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。