HeapSort algorithm now OK