Pathfinding clean up for speed.