Working on fast dijkstra