Towards Real-Time Sensor-Based Path Planning in Highly Dynamic Environments

This paper presents work on sensor-based motion planning in initially unknown dynamic environments. Motion detection and probabilistic motion modeling are combined with a smooth navigation function to perform on-line path planning and replanning in cluttered dynamic environments such as public exhibitions. The SLIP algorithm, an extension of Iterative Closest Point, combines motion detection from a mobile platform with position estimation. This information is then processed using probabilistic motion prediction to yield a co-occurrence risk that unifies dynamic and static elements. The risk is translated into traversal costs for an E* path planner. It produces smooth paths that trade off collision risk versus detours.

[1]  Roland Siegwart,et al.  Smooth and efficient obstacle avoidance for a tour guide robot , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

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

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

[4]  Neil C. Rowe,et al.  Finding Optimal-Path Maps for Path Planning across Weighted Regions , 2000, Int. J. Robotics Res..

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

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

[7]  Masayoshi Tomizuka,et al.  Collision prediction and avoidance amidst moving objects for trajectory planning applications , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

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

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

[10]  Roland Philippsen.  Motion planning and obstacle avoidance for mobile robots in highly cluttered dynamic environments , 2004 .

[11]  Zhengyou Zhang,et al.  Iterative point matching for registration of free-form curves and surfaces , 1994, International Journal of Computer Vision.

[12]  Roland Siegwart,et al.  An Interpolated Dynamic Navigation Function , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[13]  K. Madhava Krishna,et al.  On the influence of sensor capacities and environment dynamics onto collision-free motion plans , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Roland Siegwart,et al.  Robox at Expo.02: A large-scale installation of personal robots , 2003, Robotics Auton. Syst..

[15]  P. Fiorini,et al.  Motion planning in dynamic environments using the relative velocity paradigm , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[16]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

[17]  Thierry Fraichard,et al.  Trajectory planning in a dynamic workspace: a 'state-time space' approach , 1998, Adv. Robotics.

[18]  Christian Laugier,et al.  Towards real-time global motion planning in a dynamic environment using the NLVO concept , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Joseph S. B. Mitchell,et al.  The weighted region problem: finding shortest paths through a weighted planar subdivision , 1991, JACM.

[20]  Björn Jensen.  Motion tracking for human-robot interaction , 2004 .