Progress

It just need to have the part where the priority queue is updated every
time we make a change to one of the nodes, and it should work. In theory