A* Algorithm complete and a good heuristic was choosen