C++ (Cpp) GridMap::toPointCloud Examples

Example #1

File: PointCloudVisualization.cpp Project: RIVeR-Lab/ihmc-open-robotics-software

bool PointCloudVisualization::visualize(const grid_map::GridMap& map)
{
  if (pointCloudPublisher_.getNumSubscribers () < 1) return true;

  sensor_msgs::PointCloud2 pointCloud;

  map.toPointCloud(pointCloud, pointType_);

  pointCloudPublisher_.publish(pointCloud);
  return true;
}

Example #2

File: PointCloudVisualization.cpp Project: belavenir/grid_map

bool PointCloudVisualization::visualize(const grid_map::GridMap& map)
{
  if (pointCloudPublisher_.getNumSubscribers () < 1) return true;

  sensor_msgs::PointCloud2 pointCloud;

  // FIXME(cfo): segfaults when pointtype is not set!
  map.toPointCloud(pointCloud, pointType_);

  pointCloudPublisher_.publish(pointCloud);
  return true;
}