Path planning and execution in fast-changing environments with known and unknown obstacles

We present a path planner capable of efficient and real-time handling of known and unknown obstacles in highly dynamic workspaces. Known obstacles are acquired offline and stored in a world model, unknown obstacles are acquired online by one or multiple sensors. This is a typical situation for many applications. The method presented here exploits this distinction by building a static roadmap based on known obstacle information. This enables efficient path planning and real-time performance using bounded lazy evaluation thus reducing the number of costly collision test. The dynamics of the workspace are addressed by invalidation/revalidation of roadmap edges based on sensoric input. Several revalidation strategies are evaluated. The proposed path planner is probabilistically complete and utilizes global environment information to assure goal arrival, if the goal is reachable. Our approach is realized using standard PC hardware with computational requirements allowing real-time performance. Experimental results show the validity of our approach.

[1]  John T. Feddema,et al.  A capacitance-based proximity sensor for whole arm obstacle avoidance , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[2]  Mark H. Overmars,et al.  Sampling Techniques for Probabilistic Roadmap Planners , 2003 .

[3]  Dominik Henrich,et al.  Multi-Camera Collision Detection allowing for Object Occlusions , 2006 .

[4]  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..

[5]  Stephen Mann,et al.  A classified bibliography of literature on NC milling path generation , 1997, Comput. Aided Des..

[6]  Alexander Zelinsky,et al.  Planning Paths of Complete Coverage of an Unstructured Environment by a Mobile Robot , 2007 .

[7]  Lydia E. Kavraki,et al.  Path planning using lazy PRM , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[8]  Vladimir J. Lumelsky,et al.  Real-time collision avoidance in teleoperated whole-sensitive robot arm manipulators , 1993, IEEE Trans. Syst. Man Cybern..

[9]  Hongbin Zha,et al.  A Path Planner in Changing Environments by Using W-C Nodes Mapping Coupled with Lazy Edges Evaluation , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Dominik Henrich,et al.  Velocity control for safe robot guidance based on fused vision and force/torque data , 2006, 2006 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems.

[11]  John T. Feddema,et al.  Whole arm obstacle avoidance for teleoperated robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[12]  Sebastian Thrun,et al.  Anytime Dynamic A*: An Anytime, Replanning Algorithm , 2005, ICAPS.

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

[14]  S. Sathiya Keerthi,et al.  A fast procedure for computing the distance between complex objects in three-dimensional space , 1988, IEEE J. Robotics Autom..