Improved Pathfinding for NP-Not found