Bfs like algorithm implemented.

The bfs alorithm is only similar to bfs at the moment.
The complexity is not what it should be due to
the use of the path struct to track potential paths.