More fixes to the Pathfinding.