Distributed Pose-graph Optimization with Multi-level Partitioning for Collaborative SLAM

Embodied AI and Robotics Dynamic SLAM Multi-sensor Fusion
这篇文章讨论了分布式协作同时定位与地图构建(DCSLAM)的后端模块,需要在分布式环境下解决非线性姿态图优化问题,也称为SE(d)同步。大多数现有的分布式图优化算法采用简单的顺序分区方案,由于每个机器人的不同地理位置,可能导致不平衡的子图维度,从而增加了额外的通信负载。此外,当前黎曼优化算法的性能可以进一步提高。在本文中,我们提出了一种新颖的分布式姿态图优化算法,结合多级分区和加速的黎曼优化方法。首先,我们采用多级图分区算法对原始姿态图进行预处理,以构建一个平衡的优化问题。此外,受加速坐标下降方法的启发,我们设计了一种改进的黎曼块坐标下降(IRBCD)算法,并得到的临界点是全局最优的。最后,我们评估了四种常见图分区方法对子图间相关性的影响,并发现最高方案具有最佳的分区性能。此外,我们进行了模拟实验,定量证明了我们提出的算法优于现有的分布式姿态图优化协议。
The back-end module of Distributed Collaborative Simultaneous Localization and Mapping (DCSLAM) requires solving a nonlinear Pose Graph Optimization (PGO) under a distributed setting, also known as SE(d)-synchronization. Most existing distributed graph optimization algorithms employ a simple sequential partitioning scheme, which may result in unbalanced subgraph dimensions due to the different geographic locations of each robot, and hence imposes extra communication load. Moreover, the performance of current Riemannian optimization algorithms can be further accelerated. In this letter, we propose a novel distributed pose graph optimization algorithm combining multi-level partitioning with an accelerated Riemannian optimization method. Firstly, we employ the multi-level graph partitioning algorithm to preprocess the naive pose graph to formulate a balanced optimization problem. In addition, inspired by the accelerated coordinate descent method, we devise an Improved Riemannian Block Coordinate Descent (IRBCD) algorithm and the critical point obtained is globally optimal. Finally, we evaluate the effects of four common graph partitioning approaches on the correlation of the inter-subgraphs, and discover that the Highest scheme has the best partitioning performance. Also, we implement simulations to quantitatively demonstrate that our proposed algorithm outperforms the state-of-the-art distributed pose graph optimization protocols.
许愿