Update heap.hpp