HeuristicGraph class which uses A* to find paths more quickly.