Implemented basic dijkstra algo.