public void AddNode(Coord parent, Coord node)
{
TreeNode parentNode = this.nodes[GetIndexInNodes(parent)];
parentNode.AddChild(node);
TreeNode newNode = new TreeNode();
newNode.SetAll(parent,node,new List<Coord>());
this.nodes.Add(newNode);
}