Updated pathfind test