Pathfinding returns null when start == goal.
Commented out pathfinding progress printing.
Implemented path following.