Finish up heap sort