Add Dijkstra algorithm (NOT FINISHED).