Update ConstrP2Pdistance.h