Fix __init__ method of binheap
Add tests for heapify function.