Added breadth-first search and some tests
Added tests to the build_path