SimSTL: Add Implemention of BFS