AI Pathfinding Code

Not thoroughly tested. i.e., being off the map throws a million
exceptions.

Also, the code is not applied to all the existing AI.