Add shiftup to speed up heapify