Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems

This paper presents Kimera-Multi, the first multi-robot system that (i) is robust and capable of identifying and rejecting incorrect inter and intra-robot loop closures resulting from perceptual aliasing, (ii) is fully distributed and only relies on local (peer-to-peer) communication to achieve d...

Full description

Bibliographic Details
Main Authors: Tian, Yulun, Chang, Yun, Herrera Arias, Fernando, Nieto-Granda, Carlos, How, Jonathan, Carlone, Luca
Other Authors: Massachusetts Institute of Technology. Laboratory for Information and Decision Systems
Format: Article
Language:English
Published: Institute of Electrical and Electronics Engineers (IEEE) 2022
Online Access:https://hdl.handle.net/1721.1/145301
_version_ 1826204918065659904
author Tian, Yulun
Chang, Yun
Herrera Arias, Fernando
Nieto-Granda, Carlos
How, Jonathan
Carlone, Luca
author2 Massachusetts Institute of Technology. Laboratory for Information and Decision Systems
author_facet Massachusetts Institute of Technology. Laboratory for Information and Decision Systems
Tian, Yulun
Chang, Yun
Herrera Arias, Fernando
Nieto-Granda, Carlos
How, Jonathan
Carlone, Luca
author_sort Tian, Yulun
collection MIT
description This paper presents Kimera-Multi, the first multi-robot system that (i) is robust and capable of identifying and rejecting incorrect inter and intra-robot loop closures resulting from perceptual aliasing, (ii) is fully distributed and only relies on local (peer-to-peer) communication to achieve distributed localization and mapping, and (iii) builds a globally consistent metric-semantic 3D mesh model of the environment in real-time, where faces of the mesh are annotated with semantic labels. Kimera-Multi is implemented by a team of robots equipped with visual-inertial sensors. Each robot builds a local trajectory estimate and a local mesh using Kimera. When communication is available, robots initiate a distributed place recognition and robust pose graph optimization protocol based on a novel distributed graduated non-convexity algorithm. The proposed protocol allows the robots to improve their local trajectory estimates by leveraging inter-robot loop closures while being robust to outliers. Finally, each robot uses its improved trajectory estimate to correct the local mesh using mesh deformation techniques. We demonstrate Kimera-Multi in photo-realistic simulations, SLAM benchmarking datasets, and challenging outdoor datasets collected using ground robots. Both real and simulated experiments involve long trajectories (e.g., up to 800 meters per robot). The experiments show that Kimera-Multi (i) outperforms the state of the art in terms of robustness and accuracy, (ii) achieves estimation errors comparable to a centralized SLAM system while being fully distributed, (iii) is parsimonious in terms of communication bandwidth, (iv) produces accurate metric-semantic 3D meshes, and (v) is modular and can be also used for standard 3D reconstruction (i.e., without semantic labels) or for trajectory estimation (i.e., without reconstructing a 3D mesh).
first_indexed 2024-09-23T13:03:06Z
format Article
id mit-1721.1/145301
institution Massachusetts Institute of Technology
language English
last_indexed 2024-09-23T13:03:06Z
publishDate 2022
publisher Institute of Electrical and Electronics Engineers (IEEE)
record_format dspace
spelling mit-1721.1/1453012023-04-10T19:25:52Z Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems Tian, Yulun Chang, Yun Herrera Arias, Fernando Nieto-Granda, Carlos How, Jonathan Carlone, Luca Massachusetts Institute of Technology. Laboratory for Information and Decision Systems This paper presents Kimera-Multi, the first multi-robot system that (i) is robust and capable of identifying and rejecting incorrect inter and intra-robot loop closures resulting from perceptual aliasing, (ii) is fully distributed and only relies on local (peer-to-peer) communication to achieve distributed localization and mapping, and (iii) builds a globally consistent metric-semantic 3D mesh model of the environment in real-time, where faces of the mesh are annotated with semantic labels. Kimera-Multi is implemented by a team of robots equipped with visual-inertial sensors. Each robot builds a local trajectory estimate and a local mesh using Kimera. When communication is available, robots initiate a distributed place recognition and robust pose graph optimization protocol based on a novel distributed graduated non-convexity algorithm. The proposed protocol allows the robots to improve their local trajectory estimates by leveraging inter-robot loop closures while being robust to outliers. Finally, each robot uses its improved trajectory estimate to correct the local mesh using mesh deformation techniques. We demonstrate Kimera-Multi in photo-realistic simulations, SLAM benchmarking datasets, and challenging outdoor datasets collected using ground robots. Both real and simulated experiments involve long trajectories (e.g., up to 800 meters per robot). The experiments show that Kimera-Multi (i) outperforms the state of the art in terms of robustness and accuracy, (ii) achieves estimation errors comparable to a centralized SLAM system while being fully distributed, (iii) is parsimonious in terms of communication bandwidth, (iv) produces accurate metric-semantic 3D meshes, and (v) is modular and can be also used for standard 3D reconstruction (i.e., without semantic labels) or for trajectory estimation (i.e., without reconstructing a 3D mesh). 2022-09-07T18:05:36Z 2022-09-07T18:05:36Z 2022 2022-09-07T17:56:54Z Article http://purl.org/eprint/type/JournalArticle https://hdl.handle.net/1721.1/145301 Tian, Yulun, Chang, Yun, Herrera Arias, Fernando, Nieto-Granda, Carlos, How, Jonathan et al. 2022. "Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems." IEEE Transactions on Robotics, 38 (4). en 10.1109/TRO.2021.3137751 IEEE Transactions on Robotics Creative Commons Attribution-Noncommercial-Share Alike http://creativecommons.org/licenses/by-nc-sa/4.0/ application/pdf Institute of Electrical and Electronics Engineers (IEEE) arXiv
spellingShingle Tian, Yulun
Chang, Yun
Herrera Arias, Fernando
Nieto-Granda, Carlos
How, Jonathan
Carlone, Luca
Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title_full Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title_fullStr Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title_full_unstemmed Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title_short Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
title_sort kimera multi robust distributed dense metric semantic slam for multi robot systems
url https://hdl.handle.net/1721.1/145301
work_keys_str_mv AT tianyulun kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems
AT changyun kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems
AT herreraariasfernando kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems
AT nietograndacarlos kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems
AT howjonathan kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems
AT carloneluca kimeramultirobustdistributeddensemetricsemanticslamformultirobotsystems