Added test classes. Wrote a few basic methods of BreadthFirstSearch