pub fn reconstruct_path( came_from: Map<Point3D, Option<Point3D>>, start: Point3D, goal: Point3D, ) -> Vec<Point3D, U16>