Fix BinaryHeap Implementation