Add heap sort algorithm implementation & unit tests