fixed stable A* with heuristics bug
A* don't respond when number of agents > 1