47 bool fullMatch =
true;
49 point compareOrigin = origin;
51 if (origin ==
point(VGREAT, VGREAT, VGREAT))
55 compareOrigin =
sum(pts1)/pts1.
size();
65 scalar dist0 = pts0MagSqr[i];
69 scalar matchDist = matchDistances[face0I];
80 scalar minDistSqr = VGREAT;
87 (j < pts1MagSqr.size())
88 && (pts1MagSqr[j] < 1.00001*dist0 + 2*matchDist)
95 scalar distSqr =
magSqr(pts0[face0I] - pts1[facei]);
97 if (distSqr <=
sqr(matchDist) && distSqr < minDistSqr)
110 Pout<<
"Cannot find point in pts1 matching point " << face0I
111 <<
" coord:" << pts0[face0I]
112 <<
" in pts0 when using tolerance " << matchDist <<
endl;
115 Pout<<
"Searching started from:" << startI <<
" in pts1"
121 (j < pts1MagSqr.size())
122 && (pts1MagSqr[j] < 1.00001*dist0 + 2*matchDist)
129 Pout<<
" Compared coord: " << pts1[facei]
131 <<
" with difference to point "
132 <<
mag(pts1[facei] - pts0[face0I]) <<
endl;
137 from0To1[face0I] = minFacei;
159 bool fullMatch =
true;
161 point compareOrigin = origin;
163 if (origin ==
point(VGREAT, VGREAT, VGREAT))
167 compareOrigin =
sum(pts1)/pts1.
size();
177 scalar dist0 = pts0MagSqr[i];
181 scalar matchDist = matchDistances[face0I];
183 label startI =
findLower(pts1MagSqr, 0.99999*dist0 - 2*matchDist);
191 scalar minDistSqr = VGREAT;
195 const scalar minDistNorm = 0;
201 (j < pts1MagSqr.size())
202 && (pts1MagSqr[j] < 1.00001*dist0 + 2*matchDist)
209 scalar distSqr =
magSqr(pts0[face0I] - pts1[facei]);
211 scalar distNorm = (pts0Dir[face0I] & pts1Dir[facei]);
222 if (distSqr <=
sqr(matchDist) && distSqr < minDistSqr)
225 if (distNorm < minDistNorm)
227 minDistSqr = distSqr;
239 Pout<<
"Cannot find point in pts1 matching point " << face0I
240 <<
" coord:" << pts0[face0I]
241 <<
" in pts0 when using tolerance " << matchDist <<
endl;
244 Pout<<
"Searching started from:" << startI <<
" in pts1"
250 (j < pts1MagSqr.size())
251 && (pts1MagSqr[j] < 1.00001*dist0 + 2*matchDist)
258 Pout<<
" Compared coord: " << pts1[facei]
260 <<
" with difference to point "
261 <<
mag(pts1[facei] - pts0[face0I]) <<
endl;
266 from0To1[face0I] = minFacei;