Working on BFS

This should print out the nodes it traverses, but I've yet to test it.
Will rig this to keep track of paths trees and distances.