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