Efficient Local Navigation Approach for Autonomous Driving Vehicles

This paper presents an efficient and practical approach for a car navigation system (CVM-Car) based on the velocity space optimization paradigm. The method calculates the velocity control commands to keep the car in the lane while avoiding the obstacles detected by the proximity sensors. The car has to follow a road path consisting of a sequence of lanelets. This approach is a lower-level reactive control that combines the pure pursuit method to obtain a reference curvature and a reactive control algorithm that keeps the vehicle in the center of the lane' s free space while avoiding obstacles that can partially block it. CVM-Car formulates local obstacle avoidance as a constrained optimization problem in the velocity space of the car. In addition to the vehicle dynamics and obstacles constraints included by the curvature method, car-shape and non-holonomic restrictions are considered in the CVM-Car velocity space. The method has been applied to an autonomous vehicle prototype.