Reduce runing time of the DeijkstraHeap alg (use List.set instead og remove/add pair)
HeapArray