Update ConsrtP2Cdistance.cpp