Heap implementation: insert is finished; TODO: remove