[WIP] Stop finding paths when enough are found
[WIP] Pathfinder cleanups, more efficient 'd' handling