[Pathfinding] Small edits and debugging commented out.