This paper presents a robust position estimation technique for autonomous vehicles navigating urban and highway environments. It employs a probabilistic framework, integrating Monte Carlo simulation and Bayesian filtering via particle filters to represent position estimates beyond Gaussian distributions. To improve accuracy, Unscented Kalman Filtering (UKF) is used to fuse radar and lidar data, facilitating the detection of static, pole-like objects. These objects are matched with landmarks from a detailed reference map generated through 3D lidar scans. The proposed method addresses both lateral and longitudinal localisation challenges, ensuring precise vehicle positioning. Comprehensive simulation tests validate the system's effectiveness, demonstrating reliable performance across various driving conditions.
Read full abstract