Real time egomotion of a nonholonomic vehicle using LIDAR measurements
Article first published online: 23 OCT 2012
© 2012 Wiley Periodicals, Inc.
Journal of Field Robotics
Volume 30, Issue 1, pages 129–141, January / February 2013
How to Cite
Almeida, J. and Santos, V. M. (2013), Real time egomotion of a nonholonomic vehicle using LIDAR measurements. J. Field Robotics, 30: 129–141. doi: 10.1002/rob.21441
- Issue published online: 10 DEC 2012
- Article first published online: 23 OCT 2012
- Manuscript Revised: 28 AUG 2012
- Manuscript Received: 26 OCT 2011
- Portuguese Foundation for Science and Technology (FCT). Grant Number: SFRH/BD/73181/2010
This paper presents a technique to estimate in real time the egomotion of a vehicle based solely on laser range data. This technique calculates the discrepancy between closely spaced two-dimensional laser scans due to the vehicle motion using scan matching techniques. The result of the scan alignment is converted into a nonlinear motion measurement and fed into a nonholonomic extended Kalman filter model. This model better approximates the real motion of the vehicle when compared to more simplistic models, thus improving performance and immunity to outliers. The motion estimate is intended to be used for egomotion compensation in a target-tracking algorithm for situation awareness applications. In this paper, several recent scan matching algorithms were evaluated for their accuracy and computational speed: metric-based iterative closest point (MbICP), point-to-line ICP (PIICP), and polar scan matching. The proposed approach is performed in real time and provides an accurate estimate of the current robot motion. The MbICP algorithm proved to be the most advantageous scan matching algorithm, but it is still comparable to PlICP. The motion estimation algorithm is validated through experimental testing in real world conditions.