Motion Planning and Safety for Autonomous Driving

This thesis discusses two different problems in motion planning for autonomous driving. The first is the problem of optimizing a lattice planner control set for any particular autonomous driving task, with the goal of reducing planning time for that task. The driving task is encoded in the form of a dataset of trajectories executed while performing said task. In addition to improving planning time, the optimized control set should capture the driving style of the dataset. In this sense, the control set is learned from the data and is tailored to a particular task. To determine the value of control actions to add to the control set, a modified version of the Fréchet distance is used to score how useful control actions are for generating paths similar to those in the dataset. This method is then compared to the state of the art lattice planner control set optimization technique in terms of planning runtime for the learned task. The second problem is the task of extending the Responsibility-Sensitive Safety (RSS) framework by introducing swerve manoeuvres in addition to the nominal braking manoeuvres present in the framework. This includes comparing the clearance distances required by a swerve to the braking distances in the original framework. This comparison shows that swerve manoeuvres require less distance gap in order to reach safety from a braking agent in front of the autonomous vehicle at higher speeds. For more realistic swerve manoeuvres, the kinematic bicycle model is used rather than the 2-D double integrator model considered in RSS. An upper bound is then computed on the required clearance distance for a swerve manoeuvre that satisfies bicycle kinematics. A longitudinal safe following distance is then derived that is provably safe, and is shown to be lower than the following distance required by RSS at higher speeds. The use of the kinematic bicycle model is then validated by computing swerve manoeuvres with a dynamic single-track car model and Pacejka tire model, and comparing the single-track swerves to the bicycle swerves.

[1]  John M. Dolan,et al.  Motion planning under uncertainty for on-road autonomous driving , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Gireeja Ranade,et al.  Data-driven planning via imitation learning , 2017, Int. J. Robotics Res..

[3]  Kris Hauser.  Continuous Pseudoinversion of a Multivariate Function: Application to Global Redundancy Resolution , 2016, WAFR.

[4]  Sergey Levine,et al.  Learning deep control policies for autonomous aerial vehicles with MPC-guided policy search , 2015, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Alonzo Kelly,et al.  State space sampling of feasible motions for high‐performance mobile robot navigation in complex environments , 2008, J. Field Robotics.

[6]  Marco Pavone,et al.  Chance-constrained dynamic programming with application to risk-aware robotic space exploration , 2015, Autonomous Robots.

[7]  Jin-Woo Lee,et al.  Motion planning for autonomous driving with a conformal spatiotemporal lattice , 2011, 2011 IEEE International Conference on Robotics and Automation.

[8]  Haim Kaplan,et al.  Computing the Discrete Fréchet Distance in Subquadratic Time , 2012, SIAM J. Comput..

[9]  Matthias Althoff,et al.  Safety verification of autonomous vehicles for coordinated evasive maneuvers , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[10]  Anca D. Dragan,et al.  Cost Functions for Robot Motion Style , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[11]  J. Andrew Bagnell,et al.  Efficient Optimization of Control Libraries , 2011, AAAI.

[12]  Marco Pavone,et al.  Learning Sampling Distributions for Robot Motion Planning , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Elias B. Kosmatopoulos,et al.  Collision avoidance analysis for lane changing and merging , 1999, IEEE Trans. Veh. Technol..

[14]  Jonathan P. How,et al.  Socially aware motion planning with deep reinforcement learning , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[16]  Siddhartha S. Srinivasa,et al.  Distance metrics and algorithms for task space path optimization , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Marco Pavone,et al.  On Infusing Reachability-Based Safety Assurance within Probabilistic Planning Frameworks for Human-Robot Vehicle Interactions , 2018, ISER.

[18]  Fabien Moutarde,et al.  A hierarchical Model Predictive Control framework for on-road formation control of autonomous vehicles , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[19]  Matthias Althoff,et al.  Online Verification of Automated Road Vehicles Using Reachability Analysis , 2014, IEEE Transactions on Robotics.

[20]  Jonathan P. How,et al.  Motion planning for urban driving using RRT , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Jinyang Chen,et al.  Clustering of trajectories based on Hausdorff distance , 2011, 2011 International Conference on Electronics, Communications and Control (ICECC).

[22]  John M. Dolan,et al.  Learning Vehicle Surrounding-aware Lane-changing Behavior from Observed Trajectories , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[23]  Matthias Althoff,et al.  Verifying the safety of lane change maneuvers of self-driving vehicles based on formalized traffic rules , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[24]  A. Piazzi,et al.  Quintic G/sup 2/-splines for trajectory planning of autonomous vehicles , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[25]  A. Piazzi,et al.  Optimal trajectory planning with quintic G/sup 2/-splines , 2000, Proceedings of the IEEE Intelligent Vehicles Symposium 2000 (Cat. No.00TH8511).

[26]  Carola Wenk,et al.  Shape matching in higher dimensions , 2003 .

[27]  Martin Lauer,et al.  Generating Comfortable, Safe and Comprehensible Trajectories for Automated Vehicles in Mixed Traffic , 2018, 2018 21st International Conference on Intelligent Transportation Systems (ITSC).

[28]  Piotr Berman,et al.  Approximation algorithms for spanner problems and Directed Steiner Forest , 2013, Inf. Comput..

[29]  Thierry Fraichard,et al.  From Reeds and Shepp's to continuous-curvature paths , 1999, IEEE Transactions on Robotics.

[30]  Zvi Shiller,et al.  Optimal Emergency Maneuvers Of Automated Vehicles , 1996 .

[31]  Alonzo Kelly,et al.  Generating near minimal spanning control sets for constrained motion planning in discrete state spaces , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  Julius Ziegler,et al.  Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Charles C. MacAdam,et al.  Understanding and Modeling the Human Driver , 2003 .

[34]  Andrey Kormilitzin,et al.  A Primer on the Signature Method in Machine Learning , 2016, ArXiv.

[35]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[36]  Dongpu Cao,et al.  A situation-aware collision avoidance strategy for car-following , 2018, IEEE/CAA Journal of Automatica Sinica.

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

[38]  Alexandre M. Bayen,et al.  A time-dependent Hamilton-Jacobi formulation of reachable sets for continuous dynamic games , 2005, IEEE Transactions on Automatic Control.

[39]  Niccolò Baldanzini,et al.  Analysis of the minimum swerving distance for the development of a motorcycle autonomous braking system. , 2013, Accident; analysis and prevention.

[40]  C. Stiller,et al.  Driving Like a Human : Imitation Learning for Path Planning using Convolutional Neural Networks , 2017 .

[41]  Giuseppe Oriolo,et al.  Feedback control of a nonholonomic car-like robot , 1998 .

[42]  Gregory Dudek,et al.  Generating Adversarial Driving Scenarios in High-Fidelity Simulators , 2019, 2019 International Conference on Robotics and Automation (ICRA).

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

[44]  Siddhartha S. Srinivasa,et al.  CHOMP: Covariant Hamiltonian optimization for motion planning , 2013, Int. J. Robotics Res..

[45]  Jaime F. Fisac,et al.  A General Safety Framework for Learning-Based Control in Uncertain Robotic Systems , 2017, IEEE Transactions on Automatic Control.

[46]  Klaus C. J. Dietmayer,et al.  Situation Assessment of an Autonomous Emergency Brake for Arbitrary Vehicle-to-Vehicle Collision Scenarios , 2009, IEEE Transactions on Intelligent Transportation Systems.

[47]  Kevin P. Murphy,et al.  Machine learning - a probabilistic perspective , 2012, Adaptive computation and machine learning series.

[48]  Y. Rasekhipour.  Prioritized Obstacle Avoidance in Motion Planning of Autonomous Vehicles , 2017 .

[49]  Edwin Olson,et al.  Multipolicy decision-making for autonomous driving via changepoint-based behavior prediction: Theory and experiment , 2015, Autonomous Robots.

[50]  D. Swaroop,et al.  Design of emergency manoeuvres for automated highway system: obstacle avoidance problem , 1997, Proceedings of the 36th IEEE Conference on Decision and Control.

[51]  Allaa R. Hilal,et al.  Driving Maneuver Classification: A Comparison of Feature Extraction Methods , 2018, IEEE Sensors Journal.

[52]  Sebastian Scherer,et al.  Learning Heuristic Search via Imitation , 2017, CoRL.

[53]  Dinesh Manocha,et al.  Reciprocal Velocity Obstacles for real-time multi-agent navigation , 2008, 2008 IEEE International Conference on Robotics and Automation.

[54]  Nanning Zheng,et al.  Efficient Sampling-Based Motion Planning for On-Road Autonomous Driving , 2015, IEEE Transactions on Intelligent Transportation Systems.

[55]  Emilio Frazzoli,et al.  Verification and Synthesis of Admissible Heuristics for Kinodynamic Motion Planning , 2017, IEEE Robotics and Automation Letters.

[56]  Siddhartha S. Srinivasa,et al.  Learning from Experience in Manipulation Planning: Setting the Right Goals , 2011, ISRR.

[57]  Siddhartha S. Srinivasa,et al.  Legibility and predictability of robot motion , 2013, 2013 8th ACM/IEEE International Conference on Human-Robot Interaction (HRI).

[58]  A. Kelly,et al.  Differentially constrained motion planning with state lattice motion primitives , 2012 .

[59]  Jennifer Bastiaan,et al.  Numerical Evaluation of the Safety of Self-Driving Vehicles: Functionality Involving Vehicle Detection , 2018, 2018 IEEE International Conference on Vehicular Electronics and Safety (ICVES).

[60]  Krzysztof Czarnecki,et al.  Learning a Lattice Planner Control Set for Autonomous Vehicles , 2019, 2019 IEEE Intelligent Vehicles Symposium (IV).

[61]  Zvi Shiller,et al.  EMERGENCY MANEUVERS OF AUTONOMOUS VEHICLES , 1996 .

[62]  Jie Zhao,et al.  A review of moving object trajectory clustering algorithms , 2016, Artificial Intelligence Review.

[63]  J. Christian Gerdes,et al.  Safe driving envelopes for path tracking in autonomous vehicles , 2017 .

[64]  M. Pollack.  Letter to the Editor—The Maximum Capacity Through a Network , 1960 .

[65]  Nidhi Kalra,et al.  Driving to Safety , 2016 .

[66]  M. Gerdts.  Solving mixed‐integer optimal control problems by branch&bound: a case study from automobile test‐driving with gear shift , 2005 .

[67]  Francesco Borrelli,et al.  Kinematic and dynamic vehicle models for autonomous driving control design , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[68]  Hans B. Pacejka,et al.  THE MAGIC FORMULA TYRE MODEL , 1991 .

[69]  Ross A. Knepper,et al.  Model-Predictive Motion Planning: Several Key Developments for Autonomous Mobile Robots , 2014, IEEE Robotics & Automation Magazine.

[70]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[71]  Christoph Stiller,et al.  Provably Safe and Smooth Lane Changes in Mixed Trafic , 2019, 2019 IEEE Intelligent Transportation Systems Conference (ITSC).

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

[73]  Ross A. Knepper,et al.  Differentially constrained mobile robot motion planning in state lattices , 2009, J. Field Robotics.

[74]  Wheeler Ruml,et al.  Safe Temporal Planning for Urban Driving , 2019, SafeAI@AAAI.

[75]  Matthew Van Gennip.  Vehicle Dynamic Modelling and Parameter Identification for an Autonomous Vehicle , 2018 .

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

[77]  Amnon Shashua,et al.  On a Formal Model of Safe and Scalable Self-driving Cars , 2017, ArXiv.

[78]  Anca D. Dragan,et al.  Hierarchical Game-Theoretic Planning for Autonomous Vehicles , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[79]  Brigitte d'Andréa-Novel,et al.  The kinematic bicycle model: A consistent model for planning feasible trajectories for autonomous vehicles? , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[80]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[81]  Cordelia Schmid,et al.  Leveraging the Path Signature for Skeleton-based Human Action Recognition , 2017, ArXiv.

[82]  Lino Guzzella,et al.  Optimal emergency maneuvers on highways for passenger vehicles with two- and four-wheel active steering , 2010, Proceedings of the 2010 American Control Conference.

[83]  Karl Iagnemma,et al.  Gradient based path optimization method for autonomous driving , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[84]  Jarrod M. Snider.  Automatic Steering Methods for Autonomous Automobile Path Tracking , 2009 .

[85]  Leonidas J. Guibas,et al.  Approximate Map Matching with respect to the Fréchet Distance , 2011, ALENEX.

[86]  Otfried Cheong,et al.  Computing a minimum-dilation spanning tree is NP-hard , 2008, Comput. Geom..

[87]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[88]  Marilena Vendittelli,et al.  Probabilistic motion planning for redundant robots along given end-effector paths , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[89]  Matthias Althoff,et al.  CommonRoad: Composable benchmarks for motion planning on roads , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[90]  Daniel P. Huttenlocher,et al.  Distance Transforms of Sampled Functions , 2012, Theory Comput..

[91]  Eric Thorn,et al.  A Framework for Automated Driving System Testable Cases and Scenarios , 2018 .

[92]  Hongyuan Zha,et al.  Unsupervised Trajectory Clustering via Adaptive Multi-kernel-Based Shrinkage , 2015, 2015 IEEE International Conference on Computer Vision (ICCV).

[93]  Berthold K. P. Horn.  The Curve of Least Energy , 1983, TOMS.

[94]  Christian Laugier,et al.  Modeling Driver Behavior from Demonstrations in Dynamic Environments Using Spatiotemporal Lattices , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[95]  Mykel J. Kochenderfer,et al.  Scalable Decision Making with Sensor Occlusions for Autonomous Driving , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[96]  Roland Siegwart,et al.  Smooth path planning in constrained environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[97]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

[98]  Alonzo Kelly,et al.  Kinodynamic motion planning with state lattice motion primitives , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[99]  Tomás Martínez-Marín,et al.  Optimal motion planning by reinforcement learning in autonomous mobile vehicles , 2011, Robotica.

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

[101]  Wei Zhan,et al.  Constrained iterative LQR for on-road autonomous driving motion planning , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

[102]  Yu Zhang,et al.  Hybrid Trajectory Planning for Autonomous Driving in Highly Constrained Environments , 2018, IEEE Access.

[103]  Siddhartha S. Srinivasa,et al.  Movement primitives via optimization , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[104]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

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

[106]  Zvi Shiller,et al.  Emergency Maneuvers for AHS Vehicles , 1995 .

[107]  Julius Ziegler,et al.  Optimal trajectory generation for dynamic street scenarios in a Frenét Frame , 2010, 2010 IEEE International Conference on Robotics and Automation.

[108]  Lydia Tapia,et al.  PRM-RL: Long-range Robotic Navigation Tasks by Combining Reinforcement Learning and Sampling-Based Planning , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[109]  Dieter Pfoser,et al.  Addressing the Need for Map-Matching Speed: Localizing Global Curve-Matching Algorithms , 2006, 18th International Conference on Scientific and Statistical Database Management (SSDBM'06).

[110]  Alonzo Kelly,et al.  Autonomous robot navigation using advanced motion primitives , 2009, 2009 IEEE Aerospace conference.

[111]  Hongbin Zha,et al.  A real-time motion planner with trajectory optimization for autonomous vehicles , 2012, 2012 IEEE International Conference on Robotics and Automation.

[112]  H. Mannila,et al.  Computing Discrete Fréchet Distance ∗ , 1994 .

[113]  Alejandro Bordallo,et al.  Efficient Computation of Collision Probabilities for Safe Motion Planning , 2018, ArXiv.

[114]  Christian Schmidt,et al.  Research on trajectory planning in emergency situations with multiple objects , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

[115]  Florent Altché,et al.  An LSTM network for highway trajectory prediction , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

[116]  Zvi Shiller,et al.  Emergency Lane-Change Maneuvers of Autonomous Vehicles , 1998 .

[117]  Marco Pavone,et al.  Multimodal Probabilistic Model-Based Planning for Human-Robot Interaction , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).