Multi S-Graphs: An Efficient Distributed Semantic-Relational Collaborative SLAM (2401.05152v2)
Abstract: Collaborative Simultaneous Localization and Mapping (CSLAM) is critical to enable multiple robots to operate in complex environments. Most CSLAM techniques rely on raw sensor measurement or low-level features such as keyframe descriptors, which can lead to wrong loop closures due to the lack of deep understanding of the environment. Moreover, the exchange of these measurements and low-level features among the robots requires the transmission of a significant amount of data, which limits the scalability of the system. To overcome these limitations, we present Multi S-Graphs, a decentralized CSLAM system that utilizes high-level semantic-relational information embedded in the four-layered hierarchical and optimizable situational graphs for cooperative map generation and localization in structured environments while minimizing the information exchanged between the robots. To support this, we present a novel room-based descriptor which, along with its connected walls, is used to perform inter-robot loop closures, addressing the challenges of multi-robot kidnapped problem initialization. Multiple experiments in simulated and real environments validate the improvement in accuracy and robustness of the proposed approach while reducing the amount of data exchanged between robots compared to other state-of-the-art approaches. Software available within a docker image: https://github.com/snt-arg/multi_s_graphs_docker
- P. Y. Lajoie, B. Ramtoula, Y. Chang, L. Carlone, and G. Beltrame, “Door-slam: Distributed, online, and outlier resilient slam for robotic teams,” IEEE Robotics and Automation Letters, vol. 5, pp. 1656–1663, 4 2020.
- S. Zhong, Y. Qi, Z. Chen, J. Wu, H. Chen, and M. Liu, “Dcl-slam: A distributed collaborative lidar slam framework for a robotic swarm,” arXiv preprint arXiv:2210.11978, 2022.
- Y. Huang, T. Shan, F. Chen, and B. Englot, “Disco-slam: Distributed scan context-enabled multi-robot lidar slam with two-stage global-local graph optimization,” IEEE Robotics and Automation Letters, vol. 7, pp. 1150–1157, 4 2022.
- R. Azzam, T. Taha, S. Huang, and Y. Zweiri, “Feature-based visual simultaneous localization and mapping: A survey,” SN Applied Sciences, vol. 2, pp. 1–24, 2020.
- J. G. Mangelson, D. Dominic, R. M. Eustice, and R. Vasudevan, “Pairwise consistent measurement set maximization for robust multi-robot map merging,” in 2018 IEEE international conference on robotics and automation (ICRA). IEEE, 2018, pp. 2916–2923.
- N. Hughes, Y. Chang, and L. Carlone, “Hydra: A real-time spatial perception system for 3d scene graph construction and optimization,” 1 2022. [Online]. Available: https://arxiv.org/abs/2201.13360v2
- H. Bavle, J. L. Sanchez-Lopez, M. Shaheer, J. Civera, and H. Voos, “Situational graphs for robot navigation in structured indoor environments,” IEEE Robotics and Automation Letters, vol. 7, no. 4, pp. 9107–9114, 2022.
- ——, “S-graphs+: Real-time localization and mapping leveraging hierarchical representations,” IEEE Robotics and Automation Letters, vol. 8, no. 8, pp. 4927–4934, 2023.
- Y. Chang, N. Hughes, A. Ray, and L. Carlone, “Hydra-multi: Collaborative online construction of 3d scene graphs with multi-robot teams,” 2023.
- E. Greve, M. Büchner, N. Vödisch, W. Burgard, and A. Valada, “Collaborative dynamic 3d scene graphs for automated driving,” 2023.
- Y. Chang, K. Ebadi, C. E. Denniston, M. F. Ginting, A. Rosinol, A. Reinke, M. Palieri, J. Shi, A. Chatterjee, B. Morrell, A. akbar Agha-mohammadi, and L. Carlone, “Lamp 2.0: A robust multi-robot slam system for operation in challenging large-scale underground environments,” 2022.
- A. Cramariuc, L. Bernreiter, F. Tschopp, M. Fehr, V. Reijgwart, J. Nieto, R. Siegwart, and C. Cadena, “maplab 2.0 – a modular and multi-modal mapping framework,” IEEE Robotics and Automation Letters, vol. 8, no. 2, p. 520–527, Feb 2023. [Online]. Available: http://dx.doi.org/10.1109/LRA.2022.3227865
- M. Patel, M. Karrer, P. Bänninger, and M. Chli, “Covins-g: A generic back-end for collaborative visual-inertial slam,” 2023 IEEE International Conference on Robotics and Automation (ICRA), May 2023. [Online]. Available: http://dx.doi.org/10.1109/ICRA48891.2023.10160938
- P. Schmuck, T. Ziegler, M. Karrer, J. Perraudin, and M. Chli, “Covins: Visual-inertial slam for centralized collaboration,” in 2021 IEEE International Symposium on Mixed and Augmented Reality Adjunct (ISMAR-Adjunct), 2021, pp. 171–176.
- I. Deutsch, M. Liu, and R. Siegwart, “A framework for multi-robot pose graph slam,” 2016 IEEE International Conference on Real-Time Computing and Robotics, RCAR 2016, pp. 567–572, 12 2016.
- Y. Tian, Y. Chang, F. Herrera Arias, C. Nieto-Granda, J. P. How, and L. Carlone, “Kimera-multi: Robust, distributed, dense metric-semantic slam for multi-robot systems,” IEEE Transactions on Robotics, vol. 38, no. 4, p. 2022–2038, Aug 2022. [Online]. Available: http://dx.doi.org/10.1109/tro.2021.3137751
- A. Rosinol, M. Abate, Y. Chang, and L. Carlone, “Kimera: an open-source library for real-time metric-semantic localization and mapping,” 2020 IEEE International Conference on Robotics and Automation (ICRA), May 2020. [Online]. Available: http://dx.doi.org/10.1109/ICRA40945.2020.9196885
- P.-Y. Lajoie and G. Beltrame, “Swarm-slam : Sparse decentralized collaborative simultaneous localization and mapping framework for multi-robot systems,” 2023.
- G. Berton, C. Masone, and B. Caputo, “Rethinking visual geo-localization for large-scale applications,” 2022 IEEE/CVF Conference on Computer Vision and Pattern Recognition (CVPR), Jun 2022. [Online]. Available: http://dx.doi.org/10.1109/CVPR52688.2022.00483
- R. Arandjelović, P. Gronat, A. Torii, T. Pajdla, and J. Sivic, “Netvlad: Cnn architecture for weakly supervised place recognition,” IEEE Transactions on Pattern Analysis and Machine Intelligence, vol. 40, no. 6, pp. 1437–1451, 2018.
- G. Kim and A. Kim, “Scan context: Egocentric spatial descriptor for place recognition within 3d point cloud map,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2018, pp. 4802–4809.
- Y. Huang, T. Shan, F. Chen, and B. Englot, “Disco-slam: Distributed scan context-enabled multi-robot lidar slam with two-stage global-local graph optimization,” IEEE Robotics and Automation Letters, vol. 7, no. 2, pp. 1150–1157, 2022.
- S. Zhong, Y. Qi, Z. Chen, J. Wu, H. Chen, and M. Liu, “Dcl-slam: A distributed collaborative lidar slam framework for a robotic swarm,” 2022.
- Y. Wang, Z. Sun, C.-Z. Xu, S. E. Sarma, J. Yang, and H. Kong, “Lidar iris for loop-closure detection,” 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Oct 2020. [Online]. Available: http://dx.doi.org/10.1109/IROS45743.2020.9341010
- P. Bänninger, I. Alzugaray, M. Karrer, and M. Chli, “Cross-agent relocalization for decentralized collaborative slam,” in 2023 IEEE International Conference on Robotics and Automation (ICRA), 2023, pp. 5551–5557.
- N. Hughes, Y. Chang, and L. Carlone, “Hydra: A real-time spatial perception system for 3D scene graph construction and optimization,” 2022.
- G. Kim and A. Kim, “Scan context: Egocentric spatial descriptor for place recognition within 3d point cloud map,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2018, pp. 4802–4809.
- K. Koide, M. Yokozuka, S. Oishi, and A. Banno, “Voxelized gicp for fast and accurate 3d point cloud registration,” in 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021, pp. 11 054–11 059.
- Y. Huang, T. Shan, F. Chen, and B. Englot, “Disco-slam: distributed scan context-enabled multi-robot lidar slam with two-stage global-local graph optimization,” IEEE Robotics and Automation Letters, vol. 7, no. 2, pp. 1150–1157, 2021.
- R. Kümmerle, G. Grisetti, H. Strasdat, K. Konolige, and W. Burgard, “G2o: A general framework for graph optimization,” in 2011 IEEE International Conference on Robotics and Automation, 2011, pp. 3607–3613.