36 #define BOOST_PARAMETER_MAX_ARITY 7 47 DiagnosticNodelet::onInit();
48 pub_ = advertise<sensor_msgs::PointCloud2>(*
pnh_,
"output", 1);
65 pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_xyz(
new pcl::PointCloud<pcl::PointXYZ>);
68 pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud_xyzrgb(
new pcl::PointCloud<pcl::PointXYZRGB>);
69 cloud_xyzrgb->points.resize(cloud_xyz->points.size());
70 cloud_xyzrgb->is_dense = cloud_xyz->is_dense;
71 cloud_xyzrgb->width = cloud_xyz->width;
72 cloud_xyzrgb->height = cloud_xyz->height;
73 for (
size_t i = 0; i < cloud_xyz->points.size(); i++) {
75 p.x = cloud_xyz->points[i].x;
76 p.y = cloud_xyz->points[i].y;
77 p.z = cloud_xyz->points[i].z;
81 cloud_xyzrgb->points[i] = p;
83 sensor_msgs::PointCloud2 out_cloud_msg;
85 out_cloud_msg.header = cloud_msg->header;
void publish(const boost::shared_ptr< M > &message) const
void fromROSMsg(const sensor_msgs::PointCloud2 &cloud, pcl::PointCloud< T > &pcl_cloud)
virtual void convert(const sensor_msgs::PointCloud2::ConstPtr &cloud_msg)
virtual void unsubscribe()
PLUGINLIB_EXPORT_CLASS(jsk_pcl_ros_utils::PointCloudXYZToXYZRGB, nodelet::Nodelet)
void toROSMsg(const pcl::PointCloud< T > &pcl_cloud, sensor_msgs::PointCloud2 &cloud)