Update ConstrP2Ldistance.h