Likelihood-Field-Model-Based Vehicle Pose Estimation with Velodyne

Dynamic vehicle tracking is an important module for Autonomous Land Vehicle (ALV) navigation in outdoor environments. The key step for a successful tracker is to accurately estimate the pose of the vehicle. In this paper, we present a novel real-time vehicle pose estimation algorithm based on the likelihood field model built on the Velodyne LIDAR data. The likelihood field model is adopted to weight the particles, which represent the potential poses, drawn around the location of the target vehicle. Importance sampling which is speeded up with the Scaling Series algorithm, is then exploited to choose the best particle as the final vehicle's pose. The performance of the algorithm is validated on the data collected by our own ALV in various urban environments.