Dijkstra heuristic update