finished Dijkstra and test