Refactor/small updates

* Add default distances for BFS, Dijkstra
* Make sure all initializations are done correctly