Implemented expand; completed BFS

Implemented the expand function, along with a print function that should
print the moves in the correct order. BFS should now be complete and
runs correctly on test 1.