Began implementation of Breadth First Search. Added some helper functions. Still needs some abstraction. Not finished.