Function TEST

test/gpu/octree/test_approx_nearest.cpp:23–128

#include <array> // for std::array

TEST(PCL_OctreeGPU, approxNearesSearch)
{

  /*
  the test points create an octree with bounds (-1, -1, -1) and (1, 1, 1).
  point q, represents a query point
  ------------------------------------
  |                |                 |
  |                |                 |
  |                |                 |
  |                |                 |
  |                |                 |
  |----------------------------------|
  | x     | q      |                 |
  |       |        |                 |
  |-------|--------|                 |
  |       | y      |                 |
  |       |        |                 |
  ------------------------------------
  the final two point are positioned such that point 'x' is farther from query point 'q'
  than 'y', but the voxel containing 'x' is closer to  'q' than the voxel containing 'y'
  */

  const std::array<pcl::PointXYZ, 10> coords{
      pcl::PointXYZ{-1.f, -1.f, -1.f},
      pcl::PointXYZ{-1.f, -1.f, 1.f},
      pcl::PointXYZ{-1.f, 1.f, -1.f},
      pcl::PointXYZ{-1.f, 1.f, 1.f},
      pcl::PointXYZ{1.f, -1.f, -1.f},
      pcl::PointXYZ{1.f, -1.f, 1.f},
      pcl::PointXYZ{1.f, 1.f, -1.f},
      pcl::PointXYZ{1.f, 1.f, 1.f},
      pcl::PointXYZ{-0.9f, -0.2f, -0.75f},
      pcl::PointXYZ{-0.4f, -0.6f, -0.75f},
  };

  // While the GPU implementation has a fixed depth of 10 levels, octree depth in the
  // CPU implementation can vary based on the leaf size set by the user, which can
  // affect the results. Therefore results would only tally if depths match.
  //generate custom pointcloud
  constexpr pcl::index_t point_size = 1000 * coords.size();
  auto cloud = pcl::make_shared<pcl::PointCloud<pcl::PointXYZ>>(point_size, 1);

  // copy chunks of 10 points at the same time
  for (auto it = cloud->begin(); it != cloud->cend(); it += coords.size())
    std::copy(coords.cbegin(), coords.cend(), it);

  const std::vector<pcl::PointXYZ> queries = {
      {-0.4, -0.2, -0.75}, // should be different across CPU and GPU if different
                           // traversal methods are used
      {-0.6, -0.2, -0.75}, // should be same across CPU and GPU
      {1.1, 1.1, 1.1},     // out of range query
  };

  // prepare device cloud
  pcl::gpu::Octree::PointCloud cloud_device;
  cloud_device.upload(cloud->points);