Mapping and Localization in 3D Environments Using a 2D Laser Scanner and a Stereo Camera
Simultaneous localization and mapping: part I