Finished improvised heap sort. Really bad implementation I believe, needs experimation