Automated driving: Safe motion planning using positively invariant sets

This paper develops a method for safe lane changes. We leverage feedback control and constraint-admissible positively invariant sets to guarantee collision-free closed-loop trajectory tracking. Starting from an initial state of the vehicle and obstacles in the region of interest, our method steers the vehicle to the desired lane while satisfying constraints associated with the future motion of the obstacles with respect to the vehicle. We connect the initial state with the desired lane using equilibrium points and associated positively invariant sets of the vehicle dynamics, where the positively invariant sets are used to guarantee safe transitions between the equilibrium points. An autonomous highway-driving example with a receding-horizon implementation shows that our method is capable of generating safe dynamically feasible trajectories in real-time while accounting for obstacles in the environment and modeling errors.

[1]  H. E. Tseng,et al.  Linear model predictive control for lane keeping and obstacle avoidance on low curvature roads , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[2]  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).

[3]  Jonathan P. How,et al.  Real-Time Motion Planning With Applications to Autonomous Urban Driving , 2009, IEEE Transactions on Control Systems Technology.

[4]  Ilya Kolmanovsky,et al.  Safe Positively Invariant Sets for Spacecraft Obstacle Avoidance , 2015 .

[5]  Jonas Sjöberg,et al.  Predictive cruise control with autonomous overtaking , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[6]  Sebastian Thrun,et al.  Junior: The Stanford entry in the Urban Challenge , 2008, J. Field Robotics.

[7]  Rajesh Rajamani,et al.  Vehicle dynamics and control , 2005 .

[8]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[9]  Karl Berntorp,et al.  Path planning using positive invariant sets , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[10]  Stephen M. Erlien,et al.  Collision Avoidance and Stabilization for Autonomous Vehicles in Emergency Scenarios , 2017, IEEE Transactions on Control Systems Technology.

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

[12]  Francesco Borrelli,et al.  Automated driving: The role of forecasts and uncertainty - A control perspective , 2015, Eur. J. Control.

[13]  Francesco Borrelli,et al.  Integrated threat assessment and control design for roadway departure avoidance , 2012, 2012 15th International IEEE Conference on Intelligent Transportation Systems.

[14]  Karl Berntorp,et al.  Path planning and integrated collision avoidance for autonomous vehicles , 2017, 2017 American Control Conference (ACC).

[15]  Karl Berntorp,et al.  Tire-stiffness estimation by marginalized adaptive particle filter , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[16]  Stefano Di Cairano,et al.  Joint Decision Making and Motion Planning for Road Vehicles Using Particle Filtering , 2016 .

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