Speed Planning Using Bezier Polynomials with Trapezoidal Corridors

To generate safe and real-time trajectories for an autonomous vehicle in dynamic environments, path and speed decoupled planning methods are often considered. This paper studies speed planning, which mainly deals with dynamic obstacle avoidance given the planning path. The main challenges lie in the decisions in non-convex space and the trade-off between safety, comfort and efficiency performances. This work uses dynamic programming to search heuristic waypoints on the S-T graph and to construct convex feasible spaces. Further, a piecewise Bézier polynomials optimization approach with trapezoidal corridors is presented, which theoretically guarantees the safety and optimality of the trajectory. The simulations verify the effectiveness of the proposed approach.

[1]  Goele Pipeleers,et al.  Real-time motion planning in the presence of moving obstacles , 2016, 2016 European Control Conference (ECC).

[2]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, 2018 UKACC 12th International Conference on Control (CONTROL).

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

[4]  Wei Zhan,et al.  Speed profile planning in dynamic environments via temporal optimization , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[5]  Kaiyu Zheng,et al.  Speed profile optimisation for intelligent vehicles in dynamic traffic scenarios , 2020, Int. J. Syst. Sci..

[6]  Changchun Liu,et al.  Baidu Apollo EM Motion Planner , 2018, ArXiv.

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

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

[9]  Shaojie Shen,et al.  Safe Trajectory Generation for Complex Urban Environments Using Spatio-Temporal Semantic Corridor , 2019, IEEE Robotics and Automation Letters.

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

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

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

[13]  Yu Zhang,et al.  Speed Planning for Autonomous Driving via Convex Optimization , 2018, 2018 21st International Conference on Intelligent Transportation Systems (ITSC).

[14]  Yi Lin,et al.  Online Safe Trajectory Generation for Quadrotors Using Fast Marching Method and Bernstein Basis Polynomial , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Yajia Zhang,et al.  Optimal Trajectory Generation for Autonomous Vehicles Under Centripetal Acceleration Constraints for In-lane Driving Scenarios , 2019, 2019 IEEE Intelligent Transportation Systems Conference (ITSC).

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

[17]  Yu Meng,et al.  A Decoupled Trajectory Planning Framework Based on the Integration of Lattice Searching and Convex Optimization , 2019, IEEE Access.

[18]  Stephen P. Boyd,et al.  Minimum-time speed optimisation over a fixed path , 2014, Int. J. Control.

[19]  Xiaohui Li,et al.  Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications , 2016, IEEE/ASME Transactions on Mechatronics.

[20]  Yu Wang,et al.  Autonomous Driving Trajectory Optimization With Dual-Loop Iterative Anchoring Path Smoothing and Piecewise-Jerk Speed Optimization , 2021, IEEE Robotics and Automation Letters.

[21]  Fei Gao,et al.  Robust and Efficient Quadrotor Trajectory Generation for Fast Autonomous Flight , 2019, IEEE Robotics and Automation Letters.