c++: add binary_heap datastruct