Heap Sort for C