Pathfinding test now works