Real Time Cooperative Localization for Autonomous Vehicles

This paper describes a new strategy for real-time cooperative localization of autonomous vehicles. The strategy aims to improve the vehicles localization accuracy and reduce the impact of computing time of multi-sensor data fusion algorithms and vehicle-to-vehicle communication on parallel architectures. The method aims to solve localization issues in a cluster of autonomous vehicles, equipped with low-cost navigation systems in an unknown environment. It stands on multiple forms of the Kalman filter derivatives to estimate the vehicles' nonlinear model vector state, named local fusion node. The vehicles exchange their local state estimate and Covariance Intersection algorithm for merging the local vehicles' state estimate in the second node (named global data fusion node). This strategy simultaneously exploits the proprioceptive and sensors -a Global Positioning System, and a vehicle-to-vehicle transmitter and receiver-and an exteroceptive sensor, range finder, to sense their surroundings for more accurate and reliable collaborative localization.