Complete Decentralized Method for On-Line Multi-Robot Trajectory Planning in Well-formed Infrastructures

We consider a system consisting of multiple mobile robots in which the user can at any time issue relocation tasks ordering one of the robots to move from its current location to a given destination location. In this paper, we deal with the problem of finding a trajectory for each such relocation task that avoids collisions with other robots. The chosen robot plans its trajectory so as to avoid collision with other robots executing tasks that were issued earlier. We prove that if the destination of each task is an endpoint in a so-called well-formed infrastructure, then this mechanism is guaranteed to always succeed and provide a trajectory for the robot that reaches the destination without any collisions. The time-complexity of the approach is only quadratic in the number of robots. We demonstrate the applicability of the presented method on several real-world maps and compare its performance against a popular reactive approach that attempts to solve the collisions locally. Besides being dead-lock free, the presented approach generates trajectories that reach the goal significantly faster (up to 48% improvement) than the trajectories resulting from local collision avoidance.

[1]  Dinesh Manocha,et al.  ClearPath: highly parallel collision avoidance for multi-agent simulation , 2009, SCA '09.

[2]  Christian Laugier,et al.  The International Journal of Robotics Research (IJRR) - Special issue on ``Field and Service Robotics '' , 2009 .

[3]  Trevor Scott Standley Finding Optimal Solutions to Cooperative Pathfinding Problems , 2010, AAAI.

[4]  Prasanna Velagapudi,et al.  Decentralized prioritized planning in large multirobot teams , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Dinesh Manocha,et al.  Reciprocal n-Body Collision Avoidance , 2011, ISRR.

[6]  Kristi A. Morgansen,et al.  Distributed reactive collision avoidance , 2012, Autonomous Robots.

[7]  Jan Faigl,et al.  Asynchronous decentralized prioritized planning for coordination in multi-robot system , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Sukumar Ghosh,et al.  Distributed Systems , 2018 .

[9]  Paul G. Spirakis,et al.  Strong NP-Hardness of Moving Many Discs , 1984, Inf. Process. Lett..

[10]  J. Schwartz,et al.  On the Complexity of Motion Planning for Multiple Independent Objects; PSPACE- Hardness of the "Warehouseman's Problem" , 1984 .

[11]  Tomás Lozano-Pérez,et al.  On multiple moving objects , 2005, Algorithmica.

[12]  Vangalur S. Alagar,et al.  Algorithmic motion planning in robotics: Coordinated motion of several disks amidst polygonal obstacles , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[13]  J. Schwartz,et al.  On the Piano Movers' Problem: III. Coordinating the Motion of Several Independent Bodies: The Special Case of Circular Bodies Moving Amidst Polygonal Barriers , 1983 .

[14]  Cees Witteveen,et al.  Push and rotate: cooperative multi-agent path planning , 2013, AAMAS.

[15]  Dinesh Manocha,et al.  Reciprocal Velocity Obstacles for real-time multi-agent navigation , 2008, 2008 IEEE International Conference on Robotics and Automation.

[16]  Howie Choset,et al.  Subdimensional expansion for multirobot path planning , 2015, Artif. Intell..

[17]  Pavel Surynek,et al.  A novel approach to path planning for multiple robots in bi-connected graphs , 2009, 2009 IEEE International Conference on Robotics and Automation.