Connectivity Maintenance for Multi-Robot Systems Under Motion and Sensing Uncertainties Using Distributed ADMM-based Trajectory Planning

Inter-robot communication enables multi-robot systems to coordinate and execute complex missions efficiently. Thus, maintaining connectivity of the communication network between robots is essential for many multi-robot systems. In this paper, we present a trajectory planner for connectivity maintenance of a multi-robot system. Unlike previous connectivity maintenance works, we account for motion and sensing uncertainties inherent in practical robots. These uncertainties result in uncertain robot positions which directly affects the connectivity of the system. We first define a metric to quantify the connectivity of a system with uncertain robot positions. This metric is used to design our trajectory planner based on a distributed alternating direction method of multipliers (ADMM) framework. Next, we derive an approximation for the Hessian matrices required within the ADMM optimization step to reduce the computational load. Finally, simulation results are presented to statistically validate the connectivity maintenance of our trajectory planner.

[1]  Asuman E. Ozdaglar,et al.  Convergence Rate of Distributed ADMM Over Networks , 2016, IEEE Transactions on Automatic Control.

[2]  Han-Lim Choi,et al.  A Distributed ADMM Approach to Non-Myopic Path Planning for Multi-Target Tracking , 2018, IEEE Access.

[3]  Lorenzo Sabattini,et al.  Distributed Control of Multirobot Systems With Global Connectivity Maintenance , 2013, IEEE Transactions on Robotics.

[4]  Tamer Basar,et al.  Graph-theoretic approach for connectivity maintenance in mobile networks in the presence of a jammer , 2010, 49th IEEE Conference on Decision and Control (CDC).

[5]  R. Murray,et al.  Robust connectivity of networked vehicles , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

[6]  Michael Rubenstein,et al.  Shape Formation in Homogeneous Swarms Using Local Task Swapping , 2020, IEEE Transactions on Robotics.

[7]  Lorenzo Sabattini,et al.  Decentralized connectivity maintenance for cooperative control of mobile robotic systems , 2013, Int. J. Robotics Res..

[8]  Sandra Hirche,et al.  Distributed Control for Cooperative Manipulation With Event-Triggered Communication , 2020, IEEE Transactions on Robotics.

[9]  Seth Hutchinson,et al.  Robust rendezvous for multi-robot system with random node failures: an optimization approach , 2018, Autonomous Robots.

[10]  Matthias Althoff,et al.  Distributed Secure State Estimation Using Diffusion Kalman Filters and Reachability Analysis , 2019, 2019 IEEE 58th Conference on Decision and Control (CDC).

[11]  Lorenzo Sabattini,et al.  Connectivity Maintenance: Global and Optimized approach through Control Barrier Functions , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Victor Y. Pan,et al.  The complexity of the matrix eigenproblem , 1999, STOC '99.

[13]  Wolfram Burgard,et al.  Coordinated multi-robot exploration , 2005, IEEE Transactions on Robotics.

[14]  Ali Jadbabaie,et al.  Decentralized Control of Connectivity for Multi-Agent Systems , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[15]  Mac Schwager,et al.  Scalable Cooperative Transport of Cable-Suspended Loads With UAVs Using Distributed Trajectory Optimization , 2020, IEEE Robotics and Automation Letters.

[16]  Bin Wang,et al.  Confidence Analysis of Standard Deviational Ellipse and Its Extension into Higher Dimensional Euclidean Space , 2015, PloS one.

[17]  Stergios I. Roumeliotis,et al.  Multirobot Active Target Tracking With Combinations of Relative Observations , 2011, IEEE Transactions on Robotics.

[18]  Ron Alterovitz,et al.  Motion planning under uncertainty using iterative local optimization in belief space , 2012, Int. J. Robotics Res..

[19]  Vijay Kumar,et al.  Connectivity management in mobile robot teams , 2008, 2008 IEEE International Conference on Robotics and Automation.

[20]  Manfredi Maggiore,et al.  Necessary and sufficient graphical conditions for formation control of unicycles , 2005, IEEE Transactions on Automatic Control.

[21]  Dimos V. Dimarogonas,et al.  Connectedness Preserving Distributed Swarm Aggregation for Multiple Kinematic Robots , 2008, IEEE Transactions on Robotics.

[22]  Wolfram Burgard,et al.  Probabilistic Robotics (Intelligent Robotics and Autonomous Agents) , 2005 .

[23]  Timothy W. McLain,et al.  Implementing Dubins Airplane Paths on Fixed-wing UAVs , 2014 .

[24]  Lorenzo Sabattini,et al.  A Comparison Between Decentralized Local and Global Methods for Connectivity Maintenance of Multi-Robot Networks , 2019, IEEE Robotics and Automation Letters.

[25]  B. Mohar.  THE LAPLACIAN SPECTRUM OF GRAPHS y , 1991 .

[26]  Stephen P. Boyd,et al.  Distributed Optimization and Statistical Learning via the Alternating Direction Method of Multipliers , 2011, Found. Trends Mach. Learn..

[27]  Amir G. Aghdam,et al.  A Class of Bounded Distributed Control Strategies for Connectivity Preservation in Multi-Agent Systems , 2010, IEEE Transactions on Automatic Control.

[28]  V. Sunder,et al.  The Laplacian spectrum of a graph , 1990 .

[29]  Antonio Franchi,et al.  A passivity-based decentralized strategy for generalized connectivity maintenance , 2013, Int. J. Robotics Res..

[30]  Karl Henrik Johansson,et al.  Decentralized connectivity maintenance in mobile networks with bounded inputs , 2008, 2008 IEEE International Conference on Robotics and Automation.

[31]  Andrea Gasparri,et al.  Bounded Control Law for Global Connectivity Maintenance in Cooperative Multirobot Systems , 2017, IEEE Transactions on Robotics.

[32]  David J. Thuente,et al.  Line search algorithms with guaranteed sufficient decrease , 1994, TOMS.

[33]  Lorenzo Sabattini,et al.  On decentralized connectivity maintenance for mobile robotic systems , 2011, IEEE Conference on Decision and Control and European Control Conference.

[34]  Mehran Mesbahi,et al.  On maximizing the second smallest eigenvalue of a state-dependent graph Laplacian , 2006, IEEE Transactions on Automatic Control.

[35]  H. C. T. E. Fernando,et al.  Modelling, simulation and implementation of a quadrotor UAV , 2013, 2013 IEEE 8th International Conference on Industrial and Information Systems.

[36]  Robert Platt,et al.  Optimal sampling-based planning for linear-quadratic kinodynamic systems , 2013, 2013 IEEE International Conference on Robotics and Automation.

[37]  Dimos V. Dimarogonas,et al.  On the Rendezvous Problem for Multiple Nonholonomic Agents , 2007, IEEE Transactions on Automatic Control.

[38]  Magnus Egerstedt,et al.  Distributed Coordination Control of Multiagent Systems While Preserving Connectedness , 2007, IEEE Transactions on Robotics.

[39]  Michael William Newman,et al.  The Laplacian spectrum of graphs , 2001 .

[40]  Siddhartha S. Srinivasa,et al.  Decentralized estimation and control of graph connectivity in mobile sensor networks , 2008, 2008 American Control Conference.

[41]  George J. Pappas,et al.  Hybrid Control for Connectivity Preserving Flocking , 2009, IEEE Transactions on Automatic Control.