Dijkstra and IndexMinPQ moved to util package