Safety assessment of trajectories for navigation in uncertain and dynamic environments

This paper presents a probabilistic threat assessment method for reasoning about the safety of robot trajectories in uncertain and dynamic environments. For safety evaluation, the overall collision probability is used to rank candidate trajectories by considering the collision probability of known objects as well as the collision probability beyond the planning horizon. Monte Carlo sampling is used to estimate the collision probabilities. This concept is applied to a navigation framework that generates and selects trajectories in order to reach the goal location while minimizing the collision probability. Simulation scenarios are used to validate the overall crash probability and show its necessity in the proposed navigation approach.

[1]  D. Mayne,et al.  Monte Carlo techniques to estimate the conditional expectation in multi-stage non-linear filtering† , 1969 .

[2]  Dinesh Manocha,et al.  Real-time navigation of independent agents using adaptive roadmaps , 2008, SIGGRAPH '08.

[3]  E. Prassler,et al.  MAid: mobility assistance for elderly and disabled people , 1998, IECON '98. Proceedings of the 24th Annual Conference of the IEEE Industrial Electronics Society (Cat. No.98CH36200).

[4]  Dominique Gruyer,et al.  Collision Probability Assessment for Speed Control , 2008, 2008 11th International IEEE Conference on Intelligent Transportation Systems.

[5]  Andreas Krause,et al.  Unfreezing the robot: Navigation in dense, interacting crowds , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Micha Sharir,et al.  Motion Planning in the Presence of Moving Obstacles , 1985, FOCS.

[7]  William Whittaker,et al.  Autonomous Driving in Traffic: Boss and the Urban Challenge , 2009, AI Mag..

[8]  Dinesh Manocha,et al.  OBBTree: a hierarchical structure for rapid interference detection , 1996, SIGGRAPH.

[9]  Thierry Fraichard,et al.  A Short Paper about Motion Safety , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[10]  Helbing,et al.  Social force model for pedestrian dynamics. , 1995, Physical review. E, Statistical physics, plasmas, fluids, and related interdisciplinary topics.

[11]  J. Kuffner,et al.  Improved Motion Planning Speed and Safety using Regions of Inevitable Collision , 2008 .

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

[13]  Autonomous navigation in dynamic uncertain environment using probabilistic models of perception and collision risk prediction. , 2009 .

[14]  Simon J. Godsill,et al.  An Overview of Existing Methods and Recent Advances in Sequential Monte Carlo , 2007, Proceedings of the IEEE.

[15]  Dinesh Manocha,et al.  Interactive navigation of multiple agents in crowded environments , 2008, I3D '08.

[16]  Roland Siegwart,et al.  Optimal Reciprocal Collision Avoidance for Multiple Non-Holonomic Robots , 2013 .

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

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

[19]  J. P. van den Berg.  Path planning in dynamic environments , 2007 .

[20]  Jun S. Liu,et al.  Sequential Monte Carlo methods for dynamic systems , 1997 .

[21]  Nando de Freitas,et al.  An Introduction to MCMC for Machine Learning , 2004, Machine Learning.

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

[23]  Horst-Michael Groß,et al.  ShopBot: Progress in developing an interactive mobile shopping assistant for everyday use , 2008, 2008 IEEE International Conference on Systems, Man and Cybernetics.

[24]  N. Gordon,et al.  Novel approach to nonlinear/non-Gaussian Bayesian state estimation , 1993 .

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

[26]  Reuven Y. Rubinstein,et al.  Simulation and the Monte Carlo Method , 1981 .

[27]  Thierry Fraichard,et al.  Inevitable Collision States: A probabilistic perspective , 2010, 2010 IEEE International Conference on Robotics and Automation.

[28]  Erwin Prassler,et al.  Recursive Probabilistic Velocity Obstacles for Reflective Navigation , 2003, FSR.

[29]  L. Petersson,et al.  Monte Carlo based Threat Assessment: Analysis and Improvements , 2007, 2007 IEEE Intelligent Vehicles Symposium.

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

[31]  T. Kanade,et al.  Monte Carlo road safety reasoning , 2005, IEEE Proceedings. Intelligent Vehicles Symposium, 2005..

[32]  Navid Seifipour,et al.  Application of fuzzy decision making in mobile robot navigation in dynamic environments , 2009, 2009 IEEE International Conference on Fuzzy Systems.

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

[34]  Tingting Xu,et al.  The Autonomous City Explorer: Towards Natural Human-Robot Interaction in Urban Environments , 2009, Int. J. Soc. Robotics.

[35]  Lars Petersson,et al.  Statistical Threat Assessment for General Road Scenes Using Monte Carlo Sampling , 2008, IEEE Transactions on Intelligent Transportation Systems.

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

[37]  Jonas Jansson,et al.  Collision Avoidance Theory : with Application to Automotive Collision Mitigation , 2005 .

[38]  Christian Laugier,et al.  Incremental Learning of Statistical Motion Patterns With Growing Hidden Markov Models , 2007, IEEE Transactions on Intelligent Transportation Systems.

[39]  Rongxin Jiang,et al.  A Robot Collision Avoidance Scheme Based on the Moving Obstacle Motion Prediction , 2008, 2008 ISECS International Colloquium on Computing, Communication, Control, and Management.

[40]  Zbigniew Michalewicz,et al.  Path Planning in Dynamic Environments , 2005, Innovations in Robot Mobility and Control.

[41]  Matthias Althoff,et al.  Probabilistic collision state checker for crowded environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[42]  Dinesh Manocha,et al.  Reciprocal n-Body Collision Avoidance , 2011, ISRR.

[43]  Dinesh Manocha,et al.  Smooth and collision-free navigation for multiple robots under differential-drive constraints , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.