Finished up dijkstra()