Add heap sort implementation

Oops! You are completely right!