Automotive Innovation ›› 2023, Vol. 6 ›› Issue (3): 481-491.doi: 10.1007/s42154-023-00222-7

• • 上一篇    下一篇

Real-Time Optimal Trajectory Planning for Autonomous Driving with Collision Avoidance Using Convex Optimization

Guoqiang Li1 · Xudong Zhang1  · Hongliang Guo2 · Basilio Lenzo3 · Ningyuan Guo1
  

  1. 1 School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China
    2 Institute for Infocomm Research, ASTAR, Singapore, Singapore
    3 Department of Industrial Engineering, University of Padova, Padua, Italy
  • 出版日期:2023-08-21 发布日期:2023-09-21

Real-Time Optimal Trajectory Planning for Autonomous Driving with Collision Avoidance Using Convex Optimization

Guoqiang Li1 · Xudong Zhang1  · Hongliang Guo2 · Basilio Lenzo3 · Ningyuan Guo1   

  1. 1 School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China
    2 Institute for Infocomm Research, ASTAR, Singapore, Singapore
    3 Department of Industrial Engineering, University of Padova, Padua, Italy
  • Online:2023-08-21 Published:2023-09-21

摘要: An online trajectory planning method for collision avoidance is proposed to improve vehicle driving safety and comfort simultaneously. The collision-free trajectory for autonomous driving is formulated as a nonlinear optimization problem. A novel approximate convex optimization approach is developed for the online optimal trajectory in both longitudinal and lateral directions. First, a dual variable is used to model the non-convex collision-free constraint for driving safety and is calculated by solving a dual problem of the relative distance between vehicles. Second, the trajectory is further optimized in a model predictive control framework considering the safety. It realizes continuous-time and dynamic feasible motion with collision avoidance. The geometry of object vehicles is described by polygons instead of circles or ellipses in traditional methods. In order to avoid aggressive maneuver in the longitudinal and lateral directions for driving comfort, rates of the acceleration and the steering angle are restricted. The final formulated optimization problem is convex, which can be solved by using quadratic programming solvers and is computationally efficient for online application. Simulation results show that this approach can obtain similar driving performance compared to a state-of-the-art nonlinear optimization method. Furthermore, various driving scenarios are tested to evaluate the robustness and the ability for handling complex driving tasks.

Abstract: An online trajectory planning method for collision avoidance is proposed to improve vehicle driving safety and comfort simultaneously. The collision-free trajectory for autonomous driving is formulated as a nonlinear optimization problem. A novel approximate convex optimization approach is developed for the online optimal trajectory in both longitudinal and lateral directions. First, a dual variable is used to model the non-convex collision-free constraint for driving safety and is calculated by solving a dual problem of the relative distance between vehicles. Second, the trajectory is further optimized in a model predictive control framework considering the safety. It realizes continuous-time and dynamic feasible motion with collision avoidance. The geometry of object vehicles is described by polygons instead of circles or ellipses in traditional methods. In order to avoid aggressive maneuver in the longitudinal and lateral directions for driving comfort, rates of the acceleration and the steering angle are restricted. The final formulated optimization problem is convex, which can be solved by using quadratic programming solvers and is computationally efficient for online application. Simulation results show that this approach can obtain similar driving performance compared to a state-of-the-art nonlinear optimization method. Furthermore, various driving scenarios are tested to evaluate the robustness and the ability for handling complex driving tasks.