Updated My5Heap class and resolve #4