Pathfinding working with closed nodes now