Heap implementation of Heap in C