English

Optimal Vehicle Trajectory Planning for Static Obstacle Avoidance using Nonlinear Optimization

Robotics 2023-07-19 v1

Abstract

Vehicle trajectory planning is a key component for an autonomous driving system. A practical system not only requires the component to compute a feasible trajectory, but also a comfortable one given certain comfort metrics. Nevertheless, computation efficiency is critical for the system to be deployed as a commercial product. In this paper, we present a novel trajectory planning algorithm based on nonlinear optimization. The algorithm computes a kinematically feasible and comfort-optimal trajectory that achieves collision avoidance with static obstacles. Furthermore, the algorithm is time efficient. It generates an 6-second trajectory within 10 milliseconds on an Intel i7 machine or 20 milliseconds on an Nvidia Drive Orin platform.

Keywords

Cite

@article{arxiv.2307.09466,
  title  = {Optimal Vehicle Trajectory Planning for Static Obstacle Avoidance using Nonlinear Optimization},
  author = {Yajia Zhang and Hongyi Sun and Ruizhi Chai and Daike Kang and Shan Li and Liyun Li},
  journal= {arXiv preprint arXiv:2307.09466},
  year   = {2023}
}
R2 v1 2026-06-28T11:33:52.243Z