Updated My5Heap class and resolve #4

Probably should have `next = next - 1;` here to have it point to the correction position in array.