Merge pull request #2385 from czgdp1807:issue-2339

Fixes error occurs in cv::ppf_match_3d::ICP::registerModelToScene()

* corrected out of range error

* remove unnecessary changes

* fix warning

Author: czgdp1807

modules/surface_matching/src/icp.cpp

@@ -246,6 +246,7 @@ static hashtable_int* getHashtable(int* data, size_t length, int numMaxElement)
 int ICP::registerModelToScene(const Mat& srcPC, const Mat& dstPC, double& residual, Matx44d& pose)
 {
   int n = srcPC.rows;
+  CV_CheckGT(n, 0, "");
 
   const bool useRobustReject = m_rejectionScale>0;
 
@@ -280,10 +281,7 @@ int ICP::registerModelToScene(const Mat& srcPC, const Mat& dstPC, double& residu
   // walk the pyramid
   for (int level = m_numLevels-1; level >=0; level--)
   {
-    const double impact = 2;
-    double div = pow((double)impact, (double)level);
-    //double div2 = div*div;
-    const int numSamples = cvRound((double)(n/(div)));
+    const int numSamples = divUp(n, 1 << level);
     const double TolP = m_tolerance*(double)(level+1)*(level+1);
     const int MaxIterationsPyr = cvRound((double)m_maxIterations/(level+1));