Trajectory Planning for Autonomous Vehicle Using Digital Map

In this paper, an algorithm for autonomous vehicle trajectory planning is proposed. The proposed algorithm consists of two parts. In the first part, transformation of given coordinates from Cartesian system to Frenet-Serret system is applied, along with interpolation of points in trajectory. In the second part, most efficient trajectory is being chosen and optimized. The algorithm was developed in Udacity's simulator, where it was tested and compared with other similar algorithms. The algorithm shows promising performance through testing.