Finished heap implementation of PQ