Added "heapify" that takes an array and organizes it into a heap.  This should be improved.