【ROS】点云订阅，处理，发布程序模板

最新推荐文章于 2024-04-17 09:40:22 发布

原创

最新推荐文章于 2024-04-17 09:40:22 发布 · 3.2k 阅读

15 ·

CC 4.0 BY-SA版权

文章标签：

#ROS #PCL

//
// Created by ethan on 18-5-9.
//
#include <iostream>
#include <ros/ros.h>
// PCL specific includes
#include <sensor_msgs/PointCloud2.h>
#include <pcl_conversions/pcl_conversions.h>
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/sample_consensus/model_types.h>
#include <pcl/sample_consensus/method_types.h>
using namespace std;
class cut_pointcloud
{
public:
    cut_pointcloud()
    {pub = nh.advertise<sensor_msgs::PointCloud2>("/cuted_pointcloud", 1);
     sub = nh.subscribe("/velodyne_points",3,&cut_pointcloud::call_back,this); }
     void call_back(const sensor_msgs::PointCloud2ConstPtr input)
     {
	 cout<<"I RECEIVED INPUT !"<<endl;
	 pcl::fromROSMsg(*input,*cloud_in);


 	 pcl::toROSMsg(*cloud_final,cloud_out);
         cloud_out.header.stamp = ros::Time::now();
         cloud_out.header.frame_id = " ";