BFS is implemented and has been tested for simple cases, seems to be working well