Add heap sort implementation

I can't get the tests to pass using range_step, care to show me?