Fixed Pathfind2