Add Dijkstra algorithm for finding shortest path