Factored out graph cost and heuristic so that user can pass own implementation to a*. Improved unit tests for pathfinding. Removed some comment + print line leftovers from initial experimentation