Mapping Underground Structures with 3D Scans