Perform a BFS traversal until goal is reached, TODO: allow ability to find the solution path