Update ConstrP2Cdistance.h