Replaced bfs() usage by iterating over the forwardnodes.
Merge pull request #22 from fidlej/topic_no_bfs

Replaced bfs() usage by iterating over the forwardnodes