Ros发布点云文件

ros如果要发布点云文件,需要把点云文件转换为ros的点云消息格式

sensor_msgs::PointCloud2

这个需要点云库文件

#include <pcl/point_types.h>
#include <pcl_conversions//pcl_conversions.h>
#include <sensor_msgs/PointCloud2.h>
#include <pcl/io/pcd_io.h>

核心的代码是

ros::NodeHandle nh;
ros::Publisher pcl_pub = nh.advertise<sensor_msgs::PointCloud2>("/pcl_points",20);

// pcl::PointXYZ 是无颜色的点云文件时的格式,如果要发送有颜色的点云,可以换成 pcl::PointXYZRGB
pcl::PointCloud<pcl::PointXY> cloud;
 sensor_msgs::PointCloud2 output;
    
 pcl::io::loadPCDFile(files_1[i], cloud);
 pcl::toROSMsg(cloud,output);
 output.header.frame_id = "camera_init";  // 非常重要!!在 rviz 中接受消息时要把最上面的 Global Options 一栏中的 Fixed Frame 改为自己在代码中设置的 .header.frame_id,也就是 camera_init,否则无法显示
 pcl_pub.publish(output);

在CMakeList.txt文件中要添加点云库支持

find_package(PCL REQUIRED COMPONENTS io)
include_directories(
 
  ${catkin_INCLUDE_DIRS}
  ${PCL_IO_INCLUDE_DIRS}
)

 target_link_libraries(node ${catkin_LIBRARIES} ${PCL_IO_LIBRARIES})
  • 0
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值