Updated My5Heap class and resolve #4

Consider assigning `cmax` and `cindex` with the priority and index of first children, then compare `priorityArray[j]` with `cmax` instead of comparing `priorityArray[j]` with `priorityArray[j+1]`.