Implemented PriorityQueue & spec

Minor adjustments to Heap