Speed profile planning in dynamic environments via temporal optimization

To generate safe and efficient trajectories for an automated vehicle in dynamic environments, a layered approach is usually considered, which separates path planning and speed profile planning. This paper is focused on speed profile planning for a given path that is represented by a set of waypoints. The speed profile will be generated using temporal optimization which optimizes the time stamps for all waypoints along the given path. The formulation of the problem under urban driving scenarios is discussed. To speed up the computation, the non-convex temporal optimization is approximated by a set of quadratic programs which are solved iteratively using the slack convex feasible set (SCFS) algorithm. The simulations in various urban driving scenarios validate the effectiveness of the method.

[1]  Jin-Woo Lee,et al.  Tunable and stable real-time trajectory planning for urban autonomous driving , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Christoph Stiller,et al.  A generic driving strategy for urban environments , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

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

[4]  David González,et al.  Speed profile generation based on quintic Bézier curves for enhanced passenger comfort , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[5]  Qi Zhu,et al.  A practical trajectory planning framework for autonomous ground vehicles driving in urban environments , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[6]  Fabien Moutarde,et al.  Motion planning for urban autonomous driving using Bézier curves and MPC , 2016, 2016 IEEE 19th International Conference on Intelligent Transportation Systems (ITSC).

[7]  Jin-Woo Lee,et al.  Runtime-bounded tunable motion planning for autonomous driving , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

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

[9]  Wei Zhan,et al.  Spatially-partitioned environmental representation and planning architecture for on-road autonomous driving , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

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

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

[12]  Jur P. van den Berg,et al.  Extended LQR: Locally-Optimal Feedback Control for Systems with Non-Linear Dynamics and Non-Quadratic Cost , 2013, ISRR.