Optimal role and position assignment in multi-robot freely reachable formations

Abstract Many multi-robot problems require the achievement of formations as part of the overall mission. This work considers a scenario in which unlabeled homogeneous robots must adopt a given formation pattern buildable anywhere in the environment. This involves finding the relative pose of the formation in regard to the initial robot positions, understood as a translation and a rotation; and the optimal assignment of the role of each robot within the formation. This paper provides an optimal solution for the combined parameters of translation, rotation and assignment that minimizes total displacement. To achieve this objective we first formally prove that the three decision variables are separable. Since computing the optimal assignment without accounting for the rotation is a computationally expensive problem, we propose an algorithm that efficiently computes the optimal roles together with the rotation. The algorithm is provably correct and finds the optimal solution in finite time. A distributed implementation is also discussed. Simulation results characterize the complexity of our solution and demonstrate its effectiveness.

[1]  J. Munkres.  ALGORITHMS FOR THE ASSIGNMENT AND TRANSIORTATION tROBLEMS* , 1957 .

[2]  Magnus Egerstedt,et al.  Role-Assignment in Multi-Agent Coordination , 2006 .

[3]  Mac Schwager,et al.  Eyes in the Sky: Decentralized Control for the Deployment of Robotic Camera Networks , 2011, Proceedings of the IEEE.

[4]  Eduardo Montijano,et al.  Efficient multi-robot formations using distributed optimization , 2014, 53rd IEEE Conference on Decision and Control.

[5]  Stephen P. Boyd,et al.  Fast linear iterations for distributed averaging , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[6]  C. Chatfield,et al.  Fourier Analysis of Time Series: An Introduction , 1977, IEEE Transactions on Systems, Man, and Cybernetics.

[7]  Andreas Zell,et al.  Distributed role assignment in multi-robot formation , 2010 .

[8]  Vijay Kumar,et al.  Cooperative manipulation and transportation with aerial robots , 2009, Auton. Robots.

[9]  John R. Spletzer,et al.  Convex Optimization Strategies for Coordinating Large-Scale Robot Formations , 2007, IEEE Transactions on Robotics.

[10]  Andrea Gasparri,et al.  Gossip-Based Centroid and Common Reference Frame Estimation in Multiagent Systems , 2014, IEEE Transactions on Robotics.

[11]  Antonio Franchi,et al.  Decentralized control of parallel rigid formations with direction constraints and bearing measurements , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).

[12]  Dimitri P. Bertsekas,et al.  The Auction Algorithm for Assignment and Other Network Flow Problems: A Tutorial , 1990 .

[13]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[14]  Gregory S. Chirikjian,et al.  Modular Self-Reconfigurable Robot Systems [Grand Challenges of Robotics] , 2007, IEEE Robotics & Automation Magazine.

[15]  lexander,et al.  THE GENERALIZED SIMPLEX METHOD FOR MINIMIZING A LINEAR FORM UNDER LINEAR INEQUALITY RESTRAINTS , 2012 .

[16]  Jorge Cortés,et al.  Global and robust formation-shape stabilization of relative sensing networks , 2009, Autom..

[17]  Ross A. Knepper,et al.  Local motion planning for collaborative multi-robot manipulation of deformable objects , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[18]  Hyo-Sung Ahn,et al.  Formation control of mobile agents based on inter-agent distance dynamics , 2011, Autom..

[19]  Giuseppe Notarstefano,et al.  A distributed simplex algorithm for degenerate linear programs and multi-agent assignments , 2012, Autom..

[20]  Mac Schwager,et al.  Vision-Based Distributed Formation Control Without an External Positioning System , 2016, IEEE Transactions on Robotics.

[21]  Anthony Stentz,et al.  A comprehensive taxonomy for multi-robot task allocation , 2013, Int. J. Robotics Res..

[22]  Jie Lin,et al.  Coordination of groups of mobile autonomous agents using nearest neighbor rules , 2003, IEEE Trans. Autom. Control..

[23]  H. Kuhn.  The Hungarian method for the assignment problem , 1955 .

[24]  Dimitri P. Bertsekas,et al.  The Auction Algorithm for Assignment and Other Network Flow Problems , 1991 .

[25]  Lydia E. Kavraki,et al.  A Sampling-Based Tree Planner for Systems With Complex Dynamics , 2012, IEEE Transactions on Robotics.

[26]  Mireille E. Broucke,et al.  Stabilization of infinitesimally rigid formations of multi-robot networks , 2008, 2008 47th IEEE Conference on Decision and Control.

[27]  Vijay Kumar,et al.  Abstractions and controllers for groups of robots in environments with obstacles , 2010, 2010 IEEE International Conference on Robotics and Automation.

[28]  Francesco Bullo,et al.  Target assignment for robotic networks: Worst-case and stochastic performance in dense environments , 2007, 2007 46th IEEE Conference on Decision and Control.

[29]  George J. Pappas,et al.  A distributed auction algorithm for the assignment problem , 2008, 2008 47th IEEE Conference on Decision and Control.

[30]  Hyo-Sung Ahn,et al.  A survey of multi-agent formation control , 2015, Autom..

[31]  Soon-Jo Chung,et al.  Swarm assignment and trajectory optimization using variable-swarm, distributed auction assignment and sequential convex programming , 2016, Int. J. Robotics Res..

[32]  George J. Pappas,et al.  Distributed formation control with permutation symmetries , 2007, 2007 46th IEEE Conference on Decision and Control.

[33]  Soon-Jo Chung,et al.  Target Assignment in Robotic Networks: Distance Optimality Guarantees and Hierarchical Strategies , 2013, IEEE Transactions on Automatic Control.

[34]  Camillo J. Taylor,et al.  A vision-based formation control framework , 2002, IEEE Trans. Robotics Autom..