Robotic motion planning in dynamic, cluttered, uncertain environments

This paper presents a strategy for planning robot motions in dynamic, cluttered, and uncertain environments. Successful and efficient operation in such environments requires reasoning about the future system evolution and the uncertainty associated with obstacles and moving agents in the environment. This paper presents a novel procedure to account for future information gathering (and the quality of that information) in the planning process. After first presenting a formal Dynamic Programming (DP) formulation, we present a Partially Closed-loop Receding Horizon Control algorithm whose approximation to the DP solution integrates prediction, estimation, and planning while also accounting for chance constraints that arise from the uncertain location of the robot and other moving agents. Simulation results in simple static and dynamic scenarios illustrate the benefit of the algorithm over classical approaches.

[1]  Russell H. Taylor,et al.  Automatic Synthesis of Fine-Motion Strategies for Robots , 1984 .

[2]  Qiuming Zhu,et al.  Hidden Markov model for dynamic obstacle avoidance of mobile robot navigation , 1991, IEEE Trans. Robotics Autom..

[3]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[4]  Masaki Hayashi,et al.  On motion planning of mobile robots which coexist and cooperate with human , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

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

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

[7]  Michael Nikolaou,et al.  Chance‐constrained model predictive control , 1999 .

[8]  Stephen P. Boyd,et al.  Policies for simultaneous estimation and optimization , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[9]  Satoshi Kagami,et al.  A probabilistic model of human motion and navigation intent for mobile robot path planning , 2000, 2009 4th International Conference on Autonomous Robots and Agents.

[10]  Peilin Fu,et al.  Variance minimization approach for a class of dual control problems , 2002, IEEE Trans. Autom. Control..

[11]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[12]  Sebastian Thrun,et al.  Planning under Uncertainty for Reliable Health Care Robotics , 2003, FSR.

[13]  O. Bosgra,et al.  A full solution to the constrained stochastic closed-loop MPC problem via state and innovations feedback and its receding horizon implementation , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[14]  Panos E. Trahanias,et al.  Predictive control of robot velocity to avoid obstacles in dynamic environments , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[15]  O.H. Bosgra,et al.  Closed-loop stochastic model predictive control in a receding horizon implementation on a continuous polymerization reactor example , 2004, Proceedings of the 2004 American Control Conference.

[16]  F. Large,et al.  Avoiding cars and pedestrians using velocity obstacles and motion prediction , 2004, IEEE Intelligent Vehicles Symposium, 2004.

[17]  Wolfram Burgard,et al.  Learning Motion Patterns of People for Compliant Robot Motion , 2005, Int. J. Robotics Res..

[18]  Rachid Alami,et al.  A decisional framework for autonomous robots interacting with humans , 2005, ROMAN 2005. IEEE International Workshop on Robot and Human Interactive Communication, 2005..

[19]  Jun Yan,et al.  Incorporating state estimation into model predictive control and its application to network traffic control , 2005, Autom..

[20]  Yoshiaki Kuwata,et al.  Robust Constrained Receding Horizon Control for Trajectory Planning , 2005 .

[21]  L. Blackmore.  A Probabilistic Particle Control Approach to Optimal, Robust Predictive Control , 2006 .

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

[23]  Alain Lambert,et al.  Safe Path Planning in an Uncertain-Configuration Space using RRT , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Anthony Stentz,et al.  Planning with Uncertainty in Position Using High-Resolution Maps , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[25]  Stephen Cameron,et al.  3-D Path Planning and Target Trajectory Prediction for the Oxford Aerial Tracking System , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[27]  Simon Parsons,et al.  Principles of Robot Motion: Theory, Algorithms and Implementations by Howie Choset, Kevin M. Lynch, Seth Hutchinson, George Kantor, Wolfram Burgard, Lydia E. Kavraki and Sebastian Thrun, 603 pp., $60.00, ISBN 0-262-033275 , 2007, The Knowledge Engineering Review.

[28]  Giuseppe Oriolo,et al.  A Bayesian framework for optimal motion planning with uncertainty , 2008, 2008 IEEE International Conference on Robotics and Automation.

[29]  John Maurice Carson,et al.  Robust Model Predictive Control with a Reactive Safety Mode , 2008 .

[30]  L. Blackmore.  Robust Path Planning and Feedback Design Under Stochastic Uncertainty , 2008 .

[31]  Joel W. Burdick,et al.  Robotic motion planning in dynamic, cluttered, uncertain environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[32]  Du Toit,et al.  Robot motion planning in dynamic, cluttered, and uncertain environments: the Partially Closed-Loop Receding Horizon Control approach , 2010 .