Heapify Implementation + Some Other Stuff

All of my additions/changes.