Adding heap sort