Add heap.hpp, fix iheap.hpp