Reciprocal n-Body Collision Avoidance

In this paper, we present a formal approach to reciprocal n-body collision avoidance, where multiple mobile robots need to avoid collisions with each other while moving in a common workspace. In our formulation, each robot acts fully independently, and does not communicate with other robots. Based on the definition of velocity obstacles [5], we derive sufficient conditions for collision-free motion by reducing the problem to solving a low-dimensional linear program. We test our approach on several dense and complex simulation scenarios involving thousands of robots and compute collision-free actions for all of them in only a few milliseconds. To the best of our knowledge, this method is the first that can guarantee local collision-free motion for a large number of robots in a cluttered workspace.

[1]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[2]  Erwin Prassler,et al.  Reflective navigation: individual behaviors and group behaviors , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

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

[4]  Thierry Fraichard,et al.  Collision avoidance in dynamic environments: An ICS-based solution and its comparative evaluation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[5]  Daniel Thalmann,et al.  Published online in Wiley InterScience (www.interscience.wiley.com). DOI: 10.1002/cav.147 , 2022 .

[6]  Wolfram Burgard,et al.  The dynamic window approach to collision avoidance , 1997, IEEE Robotics Autom. Mag..

[7]  James J. Kuffner,et al.  Multipartite RRTs for Rapid Replanning in Dynamic Environments , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[8]  J. Trinkle,et al.  A Local Collision Avoidance Method for Non-strictly Convex Polyhedra , 2009 .

[9]  James Gil de Lamadrid,et al.  Avoidance of Obstacles With Unknown Trajectories: Locally Optimal Paths and Periodic Sensor Readings , 1994 .

[10]  Yoram Koren,et al.  The vector field histogram-fast obstacle avoidance for mobile robots , 1991, IEEE Trans. Robotics Autom..

[11]  Dinesh Manocha,et al.  Generalized velocity obstacles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[13]  Craig W. Reynolds.  Flocks, herds, and schools: a distributed behavioral model , 1998 .

[14]  Thierry Fraichard,et al.  Safe motion planning in dynamic environments , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Wolfram Burgard,et al.  Robotics: Science and Systems XV , 2010 .

[16]  Reid G. Simmons,et al.  The curvature-velocity method for local obstacle avoidance , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[17]  Hajime Asama,et al.  Inevitable collision states. A step towards safer robots? , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[18]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[19]  Ming C. Lin,et al.  Efficient collision detection for animation and robotics , 1993 .

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

[21]  James K. Kuchar,et al.  Survey of conflict detection and resolution modeling methods , 1997 .

[22]  Dirk Helbing,et al.  Simulating dynamical features of escape panic , 2000, Nature.

[23]  Erik D. Demaine,et al.  A Distributed boundary detection algorithm for multi-robot systems , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  B. Faverjon,et al.  A local based approach for path planning of manipulators with a high number of degrees of freedom , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[25]  Yasuaki Abe,et al.  Collision avoidance method for multiple autonomous mobile agents by implicit cooperation , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[26]  Dinesh Manocha,et al.  Independent navigation of multiple mobile robots with hybrid reciprocal velocity obstacles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Christian Laugier,et al.  Dynamic Obstacle Avoidance in uncertain environment combining PVOs and Occupancy Grid , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[28]  Mark de Berg,et al.  Computational geometry: algorithms and applications , 1997 .

[29]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..