Contingency Planning Over Probabilistic Obstacle Predictions for Autonomous Road Vehicles

This paper presents a novel optimization-based path planner that is capable of planning multiple contingency paths to directly account for uncertainties in the future trajectories of dynamic obstacles. This planner addresses the particular problem of probabilistic collision avoidance for autonomous road vehicles that are required to safely interact, in close proximity, with other vehicles with unknown intentions. The presented path planner utilizes an efficient spline-based trajectory representation and fast but accurate collision probability bounds to simultaneously optimize multiple continuous contingency paths in real time. These collision probability bounds are efficient enough for real-time evaluation, yet accurate enough to allow for practical close-proximity driving behaviors such as passing an obstacle vehicle in an adjacent lane. An obstacle trajectory clustering algorithm is also presented to enable the path planner to scale to multiple-obstacle scenarios. Simulation results show that the contingency planner allows for a more aggressive driving style than planning a single path without compromising the overall safety of the robot.

[1]  Brian Schimpf,et al.  Sensitivity analysis of an optimization-based trajectory planner for autonomous vehicles in urban environments , 2008, Security + Defence.

[2]  Jur P. van den Berg,et al.  Planning High-quality Paths and Corridors Amidst Obstacles , 2008, Int. J. Robotics Res..

[3]  Luke Fletcher,et al.  The MIT - Cornell Collision and Why It Happened , 2009, The DARPA Urban Challenge.

[4]  Sanjiv Singh,et al.  The DARPA Urban Challenge: Autonomous Vehicles in City Traffic, George Air Force Base, Victorville, California, USA , 2009, The DARPA Urban Challenge.

[5]  Paul T. Boggs,et al.  Sequential Quadratic Programming , 1995, Acta Numerica.

[6]  Franz Aurenhammer,et al.  A Novel Type of Skeleton for Polygons , 1995, J. Univers. Comput. Sci..

[7]  Tieniu Tan,et al.  Similarity based vehicle trajectory clustering and anomaly detection , 2005, IEEE International Conference on Image Processing 2005.

[8]  Mark E. Campbell,et al.  Contingency planning over probabilistic hybrid obstacle predictions for autonomous road vehicles , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Padhraic Smyth,et al.  Trajectory clustering with mixtures of regression models , 1999, KDD '99.

[10]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[11]  Mark H. Overmars,et al.  Creating High-quality Paths for Motion Planning , 2007, Int. J. Robotics Res..

[12]  Irfan A. Essa,et al.  Gaussian process regression flow for analysis of motion trajectories , 2011, 2011 International Conference on Computer Vision.

[13]  Inseok Hwang,et al.  Intent-Based Probabilistic Conflict Detection for the Next Generation Air Transportation System , 2008, Proc. IEEE.

[14]  Mark E. Campbell,et al.  Clustering obstacle predictions to improve contingency planning for autonomous road vehicles in congested environments , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Heinz Erzberger,et al.  Conflict probability estimation for free flight , 1997 .

[16]  Jonathan P. How,et al.  Receding horizon control of autonomous aerial vehicles , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[17]  Yoshiaki Shirai,et al.  Probabilistic Uncertainty Modeling of Obstacle Motion for Robot Motion Planning , 2002, J. Robotics Mechatronics.

[18]  S. Kolski,et al.  Detection, prediction, and avoidance of dynamic obstacles in urban environments , 2008, 2008 IEEE Intelligent Vehicles Symposium.

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

[20]  Jae-Gil Lee,et al.  Trajectory clustering: a partition-and-group framework , 2007, SIGMOD '07.

[21]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

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

[23]  Jonathan P. How,et al.  Threat-aware path planning in uncertain urban environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Joel W. Burdick,et al.  Alice: An information‐rich autonomous vehicle for high‐speed desert navigation , 2006 .

[25]  Sebastian Thrun,et al.  Path Planning for Autonomous Driving in Unknown Environments , 2008, ISER.

[26]  Salvatore Alfano.  Addressing Nonlinear Relative Motion For Spacecraft Collision Probability , 2006 .

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

[28]  Mark B. Milam,et al.  A new computational approach to real-time trajectory generation for constrained mechanical systems , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[29]  Ephrahim Garcia,et al.  Team Cornell's Skynet: Robust perception and planning in an urban environment , 2008, J. Field Robotics.

[30]  Christian Laugier,et al.  Modelling Smooth Paths Using Gaussian Processes , 2007, FSR.

[31]  Anders Forsgren,et al.  Interior Methods for Nonlinear Optimization , 2002, SIAM Rev..

[32]  Albert S. Huang,et al.  A Bayesian nonparametric approach to modeling motion patterns , 2011, Auton. Robots.

[33]  Hui X. Li,et al.  A probabilistic approach to optimal robust path planning with obstacles , 2006, 2006 American Control Conference.

[34]  Maxim Likhachev,et al.  Time-bounded lattice for efficient planning in dynamic environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[35]  R. C. Coulter,et al.  Implementation of the Pure Pursuit Path Tracking Algorithm , 1992 .

[36]  Joel W. Burdick,et al.  Alice: An information‐rich autonomous vehicle for high‐speed desert navigation , 2006, J. Field Robotics.

[37]  Mark E. Campbell,et al.  Efficient Unbiased Tracking of Multiple Dynamic Obstacles Under Large Viewpoint Changes , 2011, IEEE Transactions on Robotics.

[38]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008, J. Field Robotics.