PCL、ROS等各种类型的点云之间的转换

本文转载自 PCL、ROS等各种类型的点云之间的转换 https://zhuanlan.zhihu.com/p/55958811

如有侵权,请联系删除

pcl::PointCloud< pcl::PointXYZ > pcl的点云
pcl::PCLPointCloud2 pcl的第二种点云
sensor_msgs::PointCloud2 ROS中的点云
sensor_msgs::PointCloud ROS中的点云

1. sensor_msgs::PCLPointCloud2 <=> pcl::PCLPointCloud2

void pcl_conversions::toPCL(const sensor_msgs::PointCloud2 &, pcl::PCLPointCloud2 &)

void pcl_conversions::moveFromPCL(const pcl::PCLPointCloud2 &, const sensor_msgs::PointCloud2 &);

2. pcl::PCLPointCloud2 <=> pcl::PointCloudpcl::PointXYZ

void pcl::fromPCLPointCloud2(const pcl::PCLPointCloud2 &, pcl::PointCloud<pointT> &);

void pcl::toPCLPointCloud2(const pcl::PointCloud<pointT> &, pcl::PCLPointCloud2 &);

3. sensor_msgs::PCLPointCloud2 <=> pcl::PointCloudpcl::PointXYZ

void pcl::fromROSMsg(const sensor_msgs::PointCloud2 &, pcl::PointCloud<T> &);

void pcl::toROSMsg(const pcl::PointCloud<T> &, sensor_msgs::PointCloud2 &);

这2个函数实际上都是inline函数,调用的就是1. 2.的方法。

4. sensor_msgs::PointCloud2 <=> sensor_msgs::PointCloud

static bool sensor_msgs::convertPointCloudToPointCloud2(const sensor_msgs::PointCloud & input,sensor_msgs::PointCloud2 & output);

static bool sensor_msgs::convertPointCloud2ToPointCloud(const sensor_msgs::PointCloud2 & input,sensor_msgs::PointCloud & output);

#include <sensor_msgs/point_cloud_conversion.h>
  • 1
    点赞
  • 13
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
ROS中,可以使用PointCloud2消息类型来表示点数据。要将PCL转换ROS,可以按照以下步骤操作: 1. 创建一个PointCloud2消息对象,设置其header和fields属性。Header属性包含一些元数据,如时间戳、坐标系等,而Fields属性定义了每个点的数据类型和名称。 2. 将PCL数据转换为一个ROS消息中的二进制数据数组。这可以通过将PCL数据复制到ROS消息中的二进制数据数组中来完成。 3. 将二进制数据数组设置为PointCloud2消息对象的data属性。 4. 将PointCloud2消息对象发布到ROS话题中,以便其他节点可以接收和处理该点数据。 下面是一个示例代码,可以将一个PCL转换ROS并发布到ROS话题中: ``` #include <ros/ros.h> #include <pcl_conversions/pcl_conversions.h> #include <sensor_msgs/PointCloud2.h> #include <pcl/point_cloud.h> #include <pcl/point_types.h> int main(int argc, char **argv) { // 初始化ROS节点 ros::init(argc, argv, "pcl_to_ros_node"); ros::NodeHandle nh; // 创建一个PCL对象 pcl::PointCloud<pcl::PointXYZ> pcl_cloud; // 填充点数据(省略) // 创建一个ROS消息对象 sensor_msgs::PointCloud2 ros_cloud; // 将PCL数据转换ROS消息中的二进制数据数组 pcl::toROSMsg(pcl_cloud, ros_cloud); // 设置ROS消息对象的header和fields属性 ros_cloud.header.frame_id = "pcl_frame"; ros_cloud.header.stamp = ros::Time::now(); ros_cloud.fields.resize(3); ros_cloud.fields[0].name = "x"; ros_cloud.fields[0].offset = 0; ros_cloud.fields[0].datatype = sensor_msgs::PointField::FLOAT32; ros_cloud.fields[0].count = 1; ros_cloud.fields[1].name = "y"; ros_cloud.fields[1].offset = 4; ros_cloud.fields[1].datatype = sensor_msgs::PointField::FLOAT32; ros_cloud.fields[1].count = 1; ros_cloud.fields[2].name = "z"; ros_cloud.fields[2].offset = 8; ros_cloud.fields[2].datatype = sensor_msgs::PointField::FLOAT32; ros_cloud.fields[2].count = 1; // 设置ROS消息对象的data属性 ros_cloud.data = std::vector<uint8_t>(ros_cloud.point_step * pcl_cloud.size()); memcpy(&ros_cloud.data[0], pcl_cloud.points.data(), ros_cloud.data.size()); // 创建一个ROS话题发布者,并发布ROS消息对象 ros::Publisher pub = nh.advertise<sensor_msgs::PointCloud2>("ros_cloud_topic", 1); pub.publish(ros_cloud); // 进入ROS循环 ros::spin(); return 0; } ```

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值