private float Heuristic(Node n) { return Mathf.Sqrt((n.X - end.X) * (n.X - end.X) + (n.Y - end.Y) * (n.Y - end.Y)); }