Using extended measurements and scene merging for efficient and robust point cloud registration