Test subject2 passed. Modified the update in ContactConstuct.h and the entry point calculator (iterate over the first point)