Merge pull request PointCloudLibrary#1176 from mujin/master

updated estimateProjectionMatrix() to make the down-sampled image have t...

Author: taketwo

search/include/pcl/search/impl/organized.hpp

@@ -350,14 +350,14 @@ pcl::search::OrganizedNeighbor<PointT>::estimateProjectionMatrix ()
   std::vector<int> indices;
   indices.reserve (input_->size () >> (pyramid_level_ << 1));
 
-  for (unsigned yIdx = 0, idx = 0; yIdx < input_->height; yIdx += ySkip, idx += input_->width * (ySkip - 1))
+  for (unsigned yIdx = 0, idx = 0; yIdx < input_->height; yIdx += ySkip, idx += input_->width * ySkip)
   {
-    for (unsigned xIdx = 0; xIdx < input_->width; xIdx += xSkip, idx += xSkip)
+    for (unsigned xIdx = 0, idx2 = idx; xIdx < input_->width; xIdx += xSkip, idx2 += xSkip)
     {
-      if (!mask_ [idx])
+      if (!mask_ [idx2])
         continue;
 
-      indices.push_back (idx);
+      indices.push_back (idx2);
     }
   }