public List<int> PointsFromPath() { List<int> points = new List<int>(); foreach (Node n in FinalPath) { points.Add(n.X); points.Add(n.Y); } return points; }