Finish pq and dijkstra's algorithm