Added some priority queue routines to the heap