public void SetEndNode(Point p)
{
EndNode = Nodes.Find(x => x.GetPos() == p);
EndNode.SetColor(Color.Red);
}
public void SetStartNode(Point p)
{
StartNode = Nodes.Find(x => x.GetPos() == p);
StartNode.SetColor(Color.Green);
}
