美文网首页
Eigen Matrixxf和PCL点云相互转换样例

Eigen Matrixxf和PCL点云相互转换样例

作者: VellBibi | 来源:发表于2023-02-17 23:14 被阅读0次
    pcl::PointCloud<pcl::PointXYZI>::Ptr source_cloud = pcl::PointCloud<pcl::PointXYZI>::Ptr(
                new pcl::PointCloud<pcl::PointXYZI>);
    pcl::io::loadPCDFile(file_source, *source_cloud);
    
    // 点云转Eigen,并转为double
    Eigen::Matrix<double, 3, Eigen::Dynamic> vertices_source = source_cloud->getMatrixXfMap(3,8,0).cast<double>();
    
    // X轴移动1米
    vertices_source.colwise() += Eigen::Vector3d(1.0,0.0,0.0);
    
    // 存回点云
    source_cloud->getMatrixXfMap(3,8,0)= vertices_source.cast<float>();
    pcl::io::savePCDFileBinary("out.pcd", *source_cloud);
    

    相关文章

      网友评论

          本文标题:Eigen Matrixxf和PCL点云相互转换样例

          本文链接:https://www.haomeiwen.com/subject/vpmvkdtx.html