Planning Time-Minimal Safe Paths Amidst Unpredictably Moving Obstacles

In this paper we discuss the problem of planning safe paths amidst unpredictably moving obstacles in the plane. Given the initial positions and the maximum speeds of the moving obstacles, which we assume are disk-shaped, the regions that are possibly not collision-free are disks that grow over time. We present an approach to compute the time-minimal path between two points in the plane that avoids these growing disks. The generated paths are thus guaranteed to be collision-free with respect to the moving obstacles while being executed. We present an algorithm that runs in O (n 3 log n) time (n being the number of obstacles) for the case where the moving obstacles have the same maximum speed, and a fast implementation for the general case that is capable of planning paths amidst many growing disks within milliseconds.

[1]  J. Douglas Faires,et al.  Numerical Analysis , 1981 .

[2]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[3]  Anthony Stentz,et al.  The Focussed D* Algorithm for Real-Time Replanning , 1995, IJCAI.

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

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

[6]  Joseph S. B. Mitchell,et al.  Geometric Shortest Paths and Network Optimization , 2000, Handbook of Computational Geometry.

[7]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[8]  Seth Hutchinson,et al.  A Framework for Real-time Path Planning in Changing Environments , 2002, Int. J. Robotics Res..

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

[10]  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).

[11]  Hajime Asama,et al.  Inevitable collision states — a step towards safer robots? , 2004, Adv. Robotics.

[12]  Maja J. Mataric,et al.  Motion planning using dynamic roadmaps , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[13]  Christian Laugier,et al.  High-speed autonomous navigation with motion prediction for unknown moving obstacles , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[14]  Thierry Siméon,et al.  A PRM-based motion planner for dynamically changing environments , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

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

[16]  Hanan Samet,et al.  Planning a time-minimal motion among moving obstacles , 1993, Algorithmica.

[17]  Ee-Chien Chang,et al.  Shortest path amidst disc obstacles is computable , 2005, Int. J. Comput. Geom. Appl..

[18]  Jur P. van den Berg,et al.  Anytime path planning and replanning in dynamic environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

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

[20]  Ee-Chien Chang,et al.  Shortest Path amidst Disc Obstacles Is Computable , 2006, Int. J. Comput. Geom. Appl..

[21]  John Vannoy.  Real-time Planning of Mobile Manipulation in Dynamic Environments of Unknown Changes , 2006 .

[22]  Kostas E. Bekris,et al.  Greedy but Safe Replanning under Kinodynamic Constraints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[24]  Christian Laugier,et al.  Motion Planning in Dynamic Environments , 2007 .