Started work on A*
This required modification of Adj Matrix so we can do a greedy plotting,
should be optimal enough. Emphasis on should.