Refactored MinHeap in PathFinder and SpanningTree to generic IntrusiveMinHeap Added IntrusiveLinkedList, implemented by PathFinder.Node