Update ConsrtP2Cdistance.h