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