public NavNode GetNode(NavPolyId id)
{
NavNode node;
if (nodeDict.TryGetValue(id, out node))
{
return node;
}
if (nodes.Count >= maxNodes)
return null;
NavNode newNode = new NavNode();
newNode.ParentIndex = 0;
newNode.PolyCost = 0;
newNode.TotalCost = 0;
newNode.Id = id;
newNode.Flags = 0;
nodes.Add(newNode);
nodeDict.Add(id, newNode);
return newNode;
}