Separated BFS and diameter into separate class

Removed a lot of the test code and print statements
Added Erdos Renyi graph
Everything works!