Trajectory optimization for autonomous overtaking with visibility maximization

In this paper we present a trajectory generation method for autonomous overtaking of static obstacles in a dynamic urban environment. In these settings, blind spots can arise from perception limitations. For example, the autonomous car may have to move slightly into the opposite lane in order to cleanly see in front of a car ahead. Once it has gathered enough information about the road ahead, then the autonomous car can safely overtake. We generate safe trajectories by solving, in real-time, a non-linear constrained optimization, formulated as a Receding Horizon planner. The planner is guided by a high-level state machine, which determines when the overtake maneuver should begin. Our main contribution is a method that can maximize visibility, prioritizes safety and respects the boundaries of the road while executing the maneuver. We present experimental results in simulation with data collected during real driving.

[1]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[2]  Tzila Shamir,et al.  How should an autonomous vehicle overtake a slower moving vehicle: design and analysis of an optimal trajectory , 2004, IEEE Transactions on Automatic Control.

[3]  Klaus-Dieter Kuhnert,et al.  Wiggling through complex traffic: Planning trajectories constrained by predictions , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[4]  Emilio Frazzoli,et al.  Numerical Approach to Reachability-Guided Sampling-Based Motion Planning Under Differential Constraints , 2017, IEEE Robotics and Automation Letters.

[5]  Makoto Obayashi,et al.  Appropriate overtaking motion generating method using predictive control with suitable car dynamics , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[6]  Edwin Olson,et al.  MPDM: Multipolicy decision-making in dynamic, uncertain environments for autonomous driving , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Chris Manzie,et al.  Model predictive contouring control , 2010, 49th IEEE Conference on Decision and Control (CDC).

[8]  Ming Yang,et al.  Conflict-Probability-Estimation-Based Overtaking for Intelligent Vehicles , 2009, IEEE Transactions on Intelligent Transportation Systems.

[9]  Christoph Stiller,et al.  Real time integrated vehicle dynamics control and trajectory planning with MPC for critical maneuvers , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[10]  Masaru Ogawa,et al.  Learning-based trajectory generation for intelligent vehicles in urban environment , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[11]  Matthias Althoff,et al.  Model-Based Probabilistic Collision Detection in Autonomous Driving , 2009, IEEE Transactions on Intelligent Transportation Systems.

[12]  Javier Alonso-Mora,et al.  Parallel autonomy in automated vehicles: Safe motion generation with minimal intervention , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Francesco Borrelli,et al.  A collision avoidance system at intersections using Robust Model Predictive Control , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

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

[15]  Pongsathorn Raksincharoensak,et al.  Autonomous collision avoidance system by combined control of steering and braking using geometrically optimised vehicular trajectory , 2012 .

[16]  Julius Ziegler,et al.  Trajectory planning for Bertha — A local, continuous method , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

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

[18]  Chen Zhang,et al.  Multi-class autonomous vehicles for mobility-on-demand service , 2016, 2016 IEEE/SICE International Symposium on System Integration (SII).

[19]  Michel Parent,et al.  Cooperative autonomous driving: intelligent vehicles sharing city roads , 2005, IEEE Robotics & Automation Magazine.

[20]  Karl Berntorp,et al.  Vehicle tracking control on piecewise-clothoidal trajectories by MPC with guaranteed error bounds , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[21]  Marcelo H. Ang,et al.  Perception, Planning, Control, and Coordination for Autonomous Vehicles , 2017 .