Skip to content

Commit 223a3cd

Browse files
committed
Merge remote-tracking branch 'upstream/3.4' into merge-3.4
2 parents c8b405e + 5834bea commit 223a3cd

File tree

1 file changed

+2
-4
lines changed
  • modules/surface_matching/src

1 file changed

+2
-4
lines changed

modules/surface_matching/src/icp.cpp

Lines changed: 2 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -246,6 +246,7 @@ static hashtable_int* getHashtable(int* data, size_t length, int numMaxElement)
246246
int ICP::registerModelToScene(const Mat& srcPC, const Mat& dstPC, double& residual, Matx44d& pose)
247247
{
248248
int n = srcPC.rows;
249+
CV_CheckGT(n, 0, "");
249250

250251
const bool useRobustReject = m_rejectionScale>0;
251252

@@ -280,10 +281,7 @@ int ICP::registerModelToScene(const Mat& srcPC, const Mat& dstPC, double& residu
280281
// walk the pyramid
281282
for (int level = m_numLevels-1; level >=0; level--)
282283
{
283-
const double impact = 2;
284-
double div = pow((double)impact, (double)level);
285-
//double div2 = div*div;
286-
const int numSamples = cvRound((double)(n/(div)));
284+
const int numSamples = divUp(n, 1 << level);
287285
const double TolP = m_tolerance*(double)(level+1)*(level+1);
288286
const int MaxIterationsPyr = cvRound((double)m_maxIterations/(level+1));
289287

0 commit comments

Comments
 (0)