Exemplo n.º 1
0
 float getMeanDepth(const typename PointCloud<PointT>::ConstPtr cloud, int row_up, int row_down, int col_left, int col_right) {
   float sum = 0;
   int count = 0;
   for (int row = row_up; row < row_down; row++) {
     for (int col = col_left; col < col_right; col++) {
       const PointT &p = cloud->at(col, row);
       if (!isFinite(p)) {
         continue;
       }
       sum += p.z;
       count++;
     }
   }
   return sum / count;
 }