Dijkstra is added. The heap is modified to be more usable.