Fixed bug with Astar heuristicEstimate and Node compare