Cleanup and Addition to DFS/BFS

As commits say, I performed the clean up of some TODOs, as well as adding functionality to DFS/BFS to be used as a traversal algorithm.