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

最新推荐文章于 2024-08-28 11:28:20 发布

顿学W

最新推荐文章于 2024-08-28 11:28:20 发布

阅读量1.4k

点赞数

CC 4.0 BY-SA版权

分类专栏： SLAM 激光雷达文章标签：算法自动驾驶 ubuntu

本文链接：https://blog.csdn.net/qq_35120962/article/details/129160924

SLAM 同时被 2 个专栏收录

6 篇文章

订阅专栏

激光雷达

1 篇文章

订阅专栏

该代码示例展示了如何在ROS环境中，使用laser_geometry库将接收到的激光雷达扫描数据（LaserScan消息类型）转换为点云（PointCloud消息类型），以便进一步进行PCL滤波操作。通过创建一个订阅者来处理/LaserScan主题的数据，并发布转换后的/scan/point_cloud话题。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

如题，转换成点云，才能对点云进行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;
}