Add heap sort implementation

:)