MR.CAP: Multi-Robot Joint Control and Planning for Object Transport

Hussein Ali Jaafar,Cheng-Hao Kao,Sajad Saeedi

DOI: https://doi.org/10.1109/LCSYS.2024.3349989

2024-01-22

Abstract:With the recent influx in demand for multi-robot systems throughout industry and academia, there is an increasing need for faster, robust, and generalizable path planning algorithms. Similarly, given the inherent connection between control algorithms and multi-robot path planners, there is in turn an increased demand for fast, efficient, and robust controllers. We propose a scalable joint path planning and control algorithm for multi-robot systems with constrained behaviours based on factor graph optimization. We demonstrate our algorithm on a series of hardware and simulated experiments. Our algorithm is consistently able to recover from disturbances and avoid obstacles while outperforming state-of-the-art methods in optimization time, path deviation, and inter-robot errors. See the code and supplementary video for experiments.

Robotics

What problem does this paper attempt to address?

This paper proposes a solution to the joint control and planning problem for multi-robot collaborative object transportation. With the increasing demand for multi-robot systems in fields such as agriculture, warehousing, and hospitality, fast, robust, and scalable path planning algorithms become crucial. Meanwhile, the close connection between control algorithms and multi-robot path planning promotes their integration to reduce communication delays and achieve overall optimality.

The current solutions suffer from issues such as communication overhead, low computational efficiency, and scalability limitations. In this paper, the authors introduce a factor graph optimization-based scalable end-to-end joint planning and control framework. Leveraging the probabilistic structure of factor graphs, this approach can handle various scenarios with a focus on scalability, making it easier to add more robots and handle complex environments without significantly increasing computational complexity.

The paper compares the proposed method with existing state-of-the-art approaches, such as model predictive control (MPC) and hierarchical quadratic programming (HQP), through hardware and simulation experiments. The results demonstrate its superiority in terms of optimization time, path deviation, and inter-robot error. In the experiments, this method is able to quickly recover and maintain efficient paths while avoiding obstacles.

In summary, the main contribution of this paper is an innovative and scalable multi-robot joint control and planning algorithm. It integrates planning and control into a unified framework through factor graph optimization, improving the real-time collaborative performance and adaptability of multi-robot systems.