void OpenStartNode()
{
AStarEvadeHeapNode startNode = GetNode(_startPosition);
startNode.Open(_endPosition);
_openedList.Set(startNode);
}
void DoOpenNode(AStarEvadeHeapNode currentNode, AStarEvadeHeapNode openNode)
{
openNode.Open(currentNode, _endPosition);
_openedList.Set(openNode);
}