Adde the code to test BreadthFirstPaths class