ROS-PCL-读写点云PCD文件

最新推荐文章于 2024-09-21 22:24:40 发布

明夷TEC

最新推荐文章于 2024-09-21 22:24:40 发布

阅读量3.4k

点赞数 4

分类专栏： ROS-PCL 文章标签： pcl保存pcd pcd点云 ros点云读写pcd 读写点云

本文链接：https://blog.csdn.net/qq_39534332/article/details/89944214

版权

ROS-PCL 专栏收录该内容

1 篇文章 0 订阅

订阅专栏

1写pcd点云

cloud转pcd
　pcl::PointCloudpcl::PointXYZ cloud;
　pcl::io::savePCDFileASCII (“test.pcd”, cloud);

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

void cloudCB(const sensor_msgs::PointCloud2 &input)
{
    pcl::PointCloud<pcl::PointXYZ> cloud;
    pcl::fromROSMsg(input, cloud);
    pcl::io::savePCDFileASCII ("test.pcd", cloud);
}
main (int argc, char **argv)
{
    ros::init (argc, argv, "pcl_write");

    ROS_INFO("Started PCL write node");

    ros::NodeHandle nh;
    ros::Subscriber bat_sub = nh.subscribe("pcl_output", 10, cloudCB);

    ros::spin();
    return 0;
}

pcl_output的原点云　cloud.width = 50000 ; cloud.height = 1;　
　　生成pcd文件后，使用终端查看点云
　　$ pcl_viewer test.pcd
在这里插入图片描述

2读pcd点云并发布

读取pcd转cloud
　pcl::PointCloudpcl::PointXYZ cloud;
　pcl::io::loadPCDFile (“test.pcd”, cloud);

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

main(int argc, char **argv)
{
    ros::init (argc, argv, "pcl_read");

    ROS_INFO("Started PCL read node");

    ros::NodeHandle nh;
    ros::Publisher pcl_pub = nh.advertise<sensor_msgs::PointCloud2> ("pcl_output", 1);

    sensor_msgs::PointCloud2 output;
    pcl::PointCloud<pcl::PointXYZ> cloud;

    pcl::io::loadPCDFile ("test.pcd", cloud);

    pcl::toROSMsg(cloud, output);
    output.header.frame_id = "point_cloud";

    ros::Rate loop_rate(1);
    while (ros::ok())
    {
        pcl_pub.publish(output);
        ros::spinOnce();
        loop_rate.sleep();
    }
    return 0;
}