把单线雷达/scan输出转化成点云pointcloud

如题,转换成点云,才能对点云进行PCL滤波类的处理,就一个发布和订阅的关系,直接上代码。

#include"ros/ros.h"
#include "sensor_msgs/LaserScan.h"
#include"sensor_msgs/PointCloud.h"
#include"laser_geometry/laser_geometry.h"
laser_geometry::LaserProjection projector;
ros::Publisher scan_pub;


void ScanCallback(const sensor_msgs::LaserScan::ConstPtr &scan_in)
{
  sensor_msgs::PointCloud cloud;
projector.projectLaser(*scan_in,cloud);
scan_pub.publish(cloud);
}


int main(int argc, char **argv)
{
    ros::init(argc, argv, "laser_scan_to_pointcloud");
    ros::NodeHandle nh;
    scan_pub=nh.advertise<sensor_msgs::PointCloud>("/scan/point_cloud",1000);

    ros::Subscriber sub = nh.subscribe("/scan", 1000, ScanCallback);

    ros::spin();
    return 0;
}

  • 0
    点赞
  • 13
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值