Don't push visited vertices
Add vertex#visited
Add more connected graph to test BFS
Minor cleanup