Prototype of bfs router, no backtrack
Supportive class refactor follows