Simple Heap Sort in C