Update ConstrP2Ldistance.cpp