Added heuristics for all functions that pathfinds in the graph, including FindAndDestroy-like functions which have been rewritten to avoid using LastAction == inspect for example.

Also fixed the bug that results in agents exploring the entire map themselves
Merge branch 'Release/MileStone2/Hotfix/heuristic' of https://github.com/srnjcbsn/Beduin into Release/MileStone2/Hotfix/heuristic