Correcting Heap Sort source