arXiv:2503.03192cs.RO2025-03ICRA被引 2

首个可证明全局最优的分布式测距SLAM算法,保障多智能体导航安全

Distributed Certifiably Correct Range-Aided SLAM

  • 基于黎曼阶梯法,将集中式最优解求解扩展至分布式场景
  • 在真实多智能体数据集上达到与顶尖集中式算法相当的轨迹误差
  • 首次实现分布式测距SLAM的严格性能保证,适合高安全要求系统

可靠的同时定位与地图构建(SLAM)算法对安全关键型自主导航至关重要。在通信受限的多智能体场景中,点对点测距传感器因带宽低、数据关联明确而被广泛采用,其状态估计问题即为测距辅助SLAM(RA-SLAM)。然而,现有分布式算法缺乏对解质量的正式保证。为此,本文提出首个能高效恢复可证明全局最优解的分布式RA-SLAM算法——DCORA,其基于黎曼阶梯法,将适用于分布式确证正确位姿图优化的计算流程推广至RA-SLAM问题。我们在真实多智能体数据集上验证了DCORA的有效性,其绝对轨迹误差与最先进的集中式确证正确RA-SLAM算法相当。此外,利用合成数据进行了参数分析,揭示了常见参数对DCORA性能的影响。

原文摘要 · Abstract (English)

Reliable simultaneous localization and mapping (SLAM) algorithms are necessary for safety-critical autonomous navigation. In the communication-constrained multi-agent setting, navigation systems increasingly use point-to-point range sensors as they afford measurements with low bandwidth requirements and known data association. The state estimation problem for these systems takes the form of range-aided (RA) SLAM. However, distributed algorithms for solving the RA-SLAM problem lack formal guarantees on the quality of the returned estimate. To this end, we present the first distributed algorithm for RA-SLAM that can efficiently recover certifiably globally optimal solutions. Our algorithm, distributed certifiably correct RA-SLAM (DCORA), achieves this via the Riemannian Staircase method, where computational procedures developed for distributed certifiably correct pose graph optimization are generalized to the RA-SLAM problem. We demonstrate DCORA's efficacy on real-world multi-agent datasets by achieving absolute trajectory errors comparable to those of a state-of-the-art centralized certifiably correct RA-SLAM algorithm. Additionally, we perform a parametric study on the structure of the RA-SLAM problem using synthetic data, revealing how common parameters affect DCORA's performance.

SLAM分布式可靠性测距

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