Init Dijkstras (before MultiMap integration)
Some refactoring and fixed Dijkstras
Integrated undirected graphs and edges
Improved error handling