Finished Breadth First Search and Depth First Search implementations