Function main

apps/src/multiscale_feature_persistence_example.cpp:72–131

}

int
main(int argc, char** argv)
{
  if (argc != 2) {
    PCL_ERROR("Syntax: ./multiscale_feature_persistence_example [path_to_cloud.pcl]\n");
    return -1;
  }

  PointCloud<PointXYZ>::Ptr cloud_scene(new PointCloud<PointXYZ>());
  PCDReader reader;
  reader.read(argv[1], *cloud_scene);

  PointCloud<PointXYZ>::Ptr cloud_subsampled;
  PointCloud<Normal>::Ptr cloud_subsampled_normals;
  subsampleAndCalculateNormals(cloud_scene, cloud_subsampled, cloud_subsampled_normals);

  PCL_INFO("STATS:\ninitial point cloud size: %zu\nsubsampled point cloud size: %zu\n",
           static_cast<std::size_t>(cloud_scene->size()),
           static_cast<std::size_t>(cloud_subsampled->size()));
  visualization::CloudViewer viewer(
      "Multiscale Feature Persistence Example Visualization");
  viewer.showCloud(cloud_scene, "scene");

  MultiscaleFeaturePersistence<PointXYZ, FPFHSignature33> feature_persistence;
  std::vector<float> scale_values;
  for (float x = 2.0f; x < 3.6f; x += 0.35f)
    scale_values.push_back(x / 100.0f);
  feature_persistence.setScalesVector(scale_values);
  feature_persistence.setAlpha(1.3f);
  FPFHEstimation<PointXYZ, Normal, FPFHSignature33>::Ptr fpfh_estimation(
      new FPFHEstimation<PointXYZ, Normal, FPFHSignature33>());
  fpfh_estimation->setInputCloud(cloud_subsampled);
  fpfh_estimation->setInputNormals(cloud_subsampled_normals);
  pcl::search::KdTree<PointXYZ>::Ptr tree(new pcl::search::KdTree<PointXYZ>());
  fpfh_estimation->setSearchMethod(tree);
  feature_persistence.setFeatureEstimator(fpfh_estimation);
  feature_persistence.setDistanceMetric(pcl::CS);

  PointCloud<FPFHSignature33>::Ptr output_features(new PointCloud<FPFHSignature33>());
  auto output_indices = pcl::make_shared<pcl::Indices>();
  feature_persistence.determinePersistentFeatures(*output_features, output_indices);

  PCL_INFO("persistent features cloud size: %zu\n",
           static_cast<std::size_t>(output_features->size()));

  ExtractIndices<PointXYZ> extract_indices_filter;
  extract_indices_filter.setInputCloud(cloud_subsampled);
  extract_indices_filter.setIndices(output_indices);
  PointCloud<PointXYZ>::Ptr persistent_features_locations(new PointCloud<PointXYZ>());
  extract_indices_filter.filter(*persistent_features_locations);

  viewer.showCloud(persistent_features_locations, "persistent features");
  PCL_INFO("Persistent features have been computed. Waiting for the user to quit the "
           "visualization window.\n");

  while (!viewer.wasStopped(50)) {
  }