Removed testing print statements from pathfinding