add the small root heap sort algorithm in c++