public void Push(AStarNode node)
{
mNodes.Add(node);
mNodes.Sort();
}
public void Remove(AStarNode node)
{
mNodes.Remove(node);
//Ensure the list is sorted
mNodes.Sort();
}
private static float HeuristicEstimateCost(AStarNode curNode, AStarNode goalNode)
{
var vecCost = curNode.Position - goalNode.Position;
return(vecCost.magnitude);
}