Added more BFS and DFS tests
Rewritten BFS to match description in Wikipeadia