Updated My5Heap class and resolve #4

Try using `swap(hole, cindex)` here to avoid redundancy.