[#81] Add heap implementation