Added Dijkstra algorithm and test for it