Initial add to graph implementation and tests