ND voxel localization using large-scale 3D environmental map and RGB-D camera
6d slam - 3d mapping outdoor environments .