Use itk::PriorityQueueContainer instead of std::priority_queue

[arnaudgelas]

In the current ITK implementation the used priority queue was taken from the STL and could element could not be updated.
Instead of inserting/pushing all elements, we need to update the element if it is already in the container, else insert it.