Added BFS implementation (and testBFS.cpp to try it out :)