AI working!

AI seems to be working with a couple of heuristics and a* searching. Can
improve further. Some cases take pretty long with plenty of node
expansions.