ros sensor_msgs::PointCloud2转pcl::PCLPointCloud2并保存读取显示文件

 .h文件

#include <sensor_msgs/PointCloud2.h>
#include <pcl_conversions/pcl_conversions.h>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
// 显示的头文件
#include <pcl/visualization/cloud_viewer.h>

.cpp文件

// ros消息接受点云并压缩保存文件
void pointCloud2Callback(const sensor_msgs::PointCloud2ConstPtr &msg)
{
    // 点云2的数据格式
    pcl::PCLPointCloud2 *pointCloud2 = new pcl::PCLPointCloud2;    
    // 转化为PCL中的点云的数据格式
    pcl_conversions::toPCL(*msg, *pointCloud2);
    // 这里使用压缩保存接口
    pcl::PCDWriter pcdWriter;
    int ret = pcdWriter.writeBinaryCompressed ("your_path", *pointCloud2);
    if (ret != 0)
    {
        ROS_ERROR("writeBinaryCompressed error");
    }
    delete pointCloud2;
    
}

// 读取点云文件并显示
void readPointCloudFile()
{
    pcl::PointCloud<pcl::PointXYZ>::Ptr pointCloudData(new pcl::PointCloud<pcl::PointXYZ>);

    if (pcl::io::loadPCDFile<pcl::PointXYZ>("your_path", *pointCloudData) != 0) 
    {
        return;
    }
    static pcl::visualization::CloudViewer viewer("123");//直接创造一个显示窗口
    viewer.showCloud(pointCloudData);//窗口显示点云
    viewer.wasStopped();

}

 CMakeLists.txt中增加 

find_package(PCL REQUIRED)

include_directories(
  ${PCL_INCLUDE_DIRS}
)  

target_link_libraries(${PROJECT_NAME}
  ${PCL_LIBRARIES}
)

  • 1
    点赞
  • 6
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
class ArmConnect: public rclcpp::Node { public: ArmConnect(const arm_connect::TopicType &topic_param); ~ArmConnect() = default; Camera::ImageInfo& GetImageInfo(Camera::CameraNum num); std::vector<std::vector<double>>& GetPointCloudInfo(); void SaveCalibrationDataInfo(const std::string &filename); std::vector<CalibrationData::detection>& GetCalibrationDataInfo(); bool IsGetCalibrationIdInfo(); bool IsGetCakubrationDataInfo(); private: void ImageCallback(const sensor_msgs::msg::Image &msg); void PointCloudCallback(const sensor_msgs::msg::PointCloud2 &msg); void CalibrationDataCallback(const apriltag_msgs::msg::AprilTagDetectionArray &msg); private: rclcpp::Subscription<sensor_msgs::msg::Image>::SharedPtr image_subscriber_; Camera::ImageInfo camera_image_; std::mutex image_lock_; rclcpp::Subscription<sensor_msgs::msg::PointCloud2>::SharedPtr pointcloud_subscriber_; rclcpp::Publisher<sensor_msgs::msg::PointCloud2>:: SharedPtr pointcloud_publisher_; std::vector<std::vector<double>> pointcloud_vector_; pcl::PointCloud<pcl::PointXYZ>::Ptr point_cloud_; std::mutex pointcloud_lock_; rclcpp::Subscription<apriltag_msgs::msg::AprilTagDetectionArray>::SharedPtr calibrationdata_subscriber_; std::vector<CalibrationData::detection> calibrationdata_vector_; mutable bool calibrationdata_flag_ = false; mutable bool calibrationboard_flag_ = false; std::mutex Calibrationdata_lock_; int CalibrationID; }; 上述是一个类的定义,如何在main函数中给上述类中的 int CalibrationID 赋值
06-09

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值