Extraction and error modeling of 3D data: application to SLAM. - Viejo, Diego; Cazorla, Miguel (2006)