D.  Fontanelli, Ricciato, L., and Soatto, S., ?A Fast RANSAC?Based Registration Algorithm for Accurate Localization in Unknown Environments using LIDAR Measurements?, in Proc. IEEE Int. Conf. on Automation Science and Engineering, Scottsdale, AZ, USA, 2007.