обойти препятствие

В текущей реализации функция находит правильный путь до препятствия, но когда она начинает обходить его f следующего шага в правильном направлении становиться больше чем f предыдущих просмотренных нодТогда из открытого списка начинают выбираться неправильные ноды