PCL 不同类型的点云之间进行类型转换

PCL 不同类型的点云之间进行类型转换

可以使用PCL里面现成的函数pcl::copyPointCloud()

#include <pcl/common/impl/io.h>

    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_xyz (new pcl::PointCloud<pcl::PointXYZ> ());  
    pcl::PointCloud<pcl::PointXYZRGBA>::Ptr cloud_xyzrgba (new pcl::PointCloud<pcl::PointXYZRGBA> ());
    pcl::copyPointCloud(*cloud_xyz, *cloud_xyzrgba);

或者手动转换:

cloud_xyzrgba->points.resize(cloud_xyz->size());
for (size_t i = 0; i < cloud_xyz->points.size(); i++) {
    cloud_xyzrgb->points[i].x = cloud_xyz->points[i].x;
    cloud_xyzrgb->points[i].y = cloud_xyz->points[i].y;
    cloud_xyzrgb->points[i].z = cloud_xyz->points[i].z;
}

参考网站:
http://answers.ros.org/question/9515/how-to-convert-between-different-point-cloud-types-using-pcl/

  • 4
    点赞
  • 23
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
PCL点云换为ROS点云格式需要进行以下步骤: 1. 创建一个ROS节点和发布者对象。 ```cpp ros::NodeHandle nh; ros::Publisher cloud_pub = nh.advertise<sensor_msgs::PointCloud2>("point_cloud", 1); ``` 2. 创建一个PCL点云对象和ROS点云对象。 ```cpp pcl::PointCloud<pcl::PointXYZ>::Ptr pcl_cloud(new pcl::PointCloud<pcl::PointXYZ>); sensor_msgs::PointCloud2 ros_cloud; ``` 3. 将PCL点云对象换为ROS点云对象。 ```cpp pcl::toROSMsg(*pcl_cloud, ros_cloud); ``` 4. 设置ROS点云对象的header信息。 ```cpp ros_cloud.header.frame_id = "base_link"; ros_cloud.header.stamp = ros::Time::now(); ``` 5. 发布ROS点云对象。 ```cpp cloud_pub.publish(ros_cloud); ``` 完整代码示例: ```cpp #include <ros/ros.h> #include <sensor_msgs/PointCloud2.h> #include <pcl_conversions/pcl_conversions.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_publisher"); ros::NodeHandle nh; // 创建发布者对象 ros::Publisher cloud_pub = nh.advertise<sensor_msgs::PointCloud2>("point_cloud", 1); // 创建PCL点云对象 pcl::PointCloud<pcl::PointXYZ>::Ptr pcl_cloud(new pcl::PointCloud<pcl::PointXYZ>); // 填充PCL点云对象 // 将PCL点云对象换为ROS点云对象 sensor_msgs::PointCloud2 ros_cloud; pcl::toROSMsg(*pcl_cloud, ros_cloud); // 设置ROS点云对象的header信息 ros_cloud.header.frame_id = "base_link"; ros_cloud.header.stamp = ros::Time::now(); // 发布ROS点云对象 cloud_pub.publish(ros_cloud); // 循环等待 ros::spin(); return 0; } ```
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值