Path and Trajectory Planning for Vehicles with Navigation Assistants

Abstract

For autonomous vehicles an important problem is to plan and accurately follow the optimal trajectory between the start point and the target, without collision with the obstacles placed in the environment. In order to obtain a continuous motion along the planned path for a vehicle with navigation assistants, especially when avoiding obstacles, the transition between a straight segment and circle arcs has to be done through using an additional curve. This paper present an algorithm based on clothoid curves for optimal steering using as case a vehicle with navigation assistants. The developed algorithm has been tested in a real environment and results have been presented.