Simpleme Heap implementation in C