SkimImage.cpp

Go to the documentation of this file.

#include <ros/ros.h>
#include <iostream>
#include <pcl_ros/point_cloud.h>
#include <pcl/point_types.h>
#include "pcl/io/pcd_io.h"

#include "ClearpathPointCloudTools.h"

typedef pcl::PointXYZRGB PointType;
typedef pcl::PointCloud<PointType> PointCloud;

ros::Publisher pub;

int skim_factor = 1;

void callback(const PointCloud::ConstPtr& cloud)
{
    PointCloud result;
    ClearpathPointCloudTools::SkimPointCloudImage((PointCloud*)&(*cloud), &result, (unsigned int)skim_factor);
    pub.publish (result);
}

int main(int argc, char** argv)
{
    ros::init (argc, argv, "skim_default");
    
    ros::NodeHandle nh = ros::NodeHandle(ros::this_node::getName());
    std::string in, out;
    nh.param<std::string>("in", in, "skim_in");
    nh.param<std::string>("out", out, "skim_out");
    nh.param<int>("skim_factor", skim_factor, 1);

    ros::NodeHandle nx;
    ros::Subscriber sub = nx.subscribe<PointCloud>(in, 1, callback);
    pub = nx.advertise<PointCloud> (out, 1);

    ros::spin();

    return (0);
}