Reimplemented a basic BFSLength function
Initial implementation of BFS testing