A* bug fixed

Ошибку поправил, но путь A* строит все-равно плохой.