- Added some AStar pathfinding code. Needs some work for groups and some other optimisations.