arXiv:2601.08110cs.ROcs.IT2026-01

新方法让SLAM实时运行更快更准,只在关键时重算。

Efficient Incremental SLAM via Information-Guided and Selective Optimization

  • 用信息量判断是否需全局优化,避免无意义计算
  • 只更新受新数据影响的变量,节省大量运算
  • 精度媲美完整优化,适合机器人实时导航

我们提出一种高效的增量式SLAM后端,可在保持全批量优化精度的同时显著降低计算成本。该方法结合两项互补机制:信息引导门控(IGG)与选择性部分优化(SPO)。IGG基于信息矩阵的对数行列式设计信息论准则,量化新测量的贡献,仅在信息增益显著时触发全局优化,避免在信息增量小的情况下进行不必要的重线性化和分解。SPO执行多轮高斯-牛顿(GN)更新,但每轮仅作用于受新数据影响最显著的变量子集,并动态调整活跃变量集直至收敛。二者协同工作,在保留所有测量以维持全局一致性的同时,将计算资源聚焦于收益最大的图结构部分。我们提供了理论分析,证明该方法保持了完整GN的收敛性保证。在多个基准SLAM数据集上的实验表明,该方法始终达到与批处理求解器相当的估计精度,同时相比传统增量方法实现显著的计算效率提升。结果表明,该方法在精度与效率之间实现了原理性的平衡,适用于动态、数据密集环境中的实时可靠运行。

原文摘要 · Abstract (English)

We present an efficient incremental SLAM back-end that achieves the accuracy of full batch optimization while substantially reducing computational cost. The proposed approach combines two complementary ideas: information-guided gating (IGG) and selective partial optimization (SPO). IGG employs an information-theoretic criterion based on the log-determinant of the information matrix to quantify the contribution of new measurements, triggering global optimization only when a significant information gain is observed. This avoids unnecessary relinearization and factorization when incoming data provide little additional information. SPO executes multi-iteration Gauss-Newton (GN) updates but restricts each iteration to the subset of variables most affected by the new measurements, dynamically refining this active set until convergence. Together, these mechanisms retain all measurements to preserve global consistency while focusing computation on parts of the graph where it yields the greatest benefit. We provide theoretical analysis showing that the proposed approach maintains the convergence guarantees of full GN. Extensive experiments on benchmark SLAM datasets show that our approach consistently matches the estimation accuracy of batch solvers, while achieving significant computational savings compared to conventional incremental approaches. The results indicate that the proposed approach offers a principled balance between accuracy and efficiency, making it a robust and scalable solution for real-time operation in dynamic data-rich environments.

SLAM优化算法机器人

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