Greatly reduce number of pathfinds (#256)

Sort all objectives by distance, and
pathfind on closest objectives first