Huffman tree building with heap in C++ is drafted