Pathfinding for AI

It's not perfect yet, but it appears to work well with 1 AI.