SLAM-based 3D surveying