PCL:点云保存遇到的问题及解决方法

之前已经完成kinect2实时获取点云,那么接下来准备将点云保存到本地,点云扩展名为pcd。在网上查找资料普遍都是这个方法。

12115116-fc4182ad04a33972.png

我就按着这个步骤尝试,首先创建一个空点云(pcl::PointCloud<pcl::PointXYZ> cloud;),接着定义点云的大小和格式,然后把信息写入点云,再使用(pcl::io::savePCDFileASCII ("test_pcd.pcd", cloud);),保存为pcd文件。

但是在将点写入点云时,遇到了点问题,因为我的点是通过像素坐标系转换成相机坐标系得到的,所以无法直接使用遍历size来将点写入,这也是我之前输出点云为什么只有一半的原因。

12115116-96a9f04b2669ea5d.png
一半点云缺失

12115116-cad28b5f2822c0d5.png
之前的点云写入代码

再通过仔细观察后,终于找到了问题所在根源,因为points的写入方法是按顺序从0~mn-1遍历写入,如图(m,n为矩阵下标):

12115116-fbb39ccfb6fa0911.png

所以就会出现如下情况:当 m=10,n=20时,m
n=200,但是m=20,n=10时,m*n也是200,意思就是当写入点(20,10)时,就会 覆盖上一个(10,20)点的写入,就出现了上述一半点云无法显示的问题,就如上图红线下方区域无法显示。

解决方法是:

12115116-1f86e285b3200d4b.png

在写入点的时候修改成m*423+n就可以完美解决这个问题,每个点都有且只有一个数对应。修改完后完美显示。

12115116-3ffc5083bab81ea7.png

很抱歉,错误信息提示中提到的 `pcl::ExtractPolygonalPrismData<pcl::PointXYZ>` 类没有名为 `setInputMesh` 的成员函数。这可能是因为你使用的 PCL 版本较低,或者你使用的是不正确的类。 在较新的 PCL 版本中,用于设置输入多边形网格的函数名是 `setInputPlanarHull` 而不是 `setInputMesh`。因此,你可以尝试将代码中的 `setInputMesh` 替换为 `setInputPlanarHull`。 以下是修改后的代码示例: ```cpp #include <pcl/point_cloud.h> #include <pcl/point_types.h> #include <pcl/io/pcd_io.h> #include <pcl/filters/extract_indices.h> #include <pcl/features/normal_3d.h> #include <pcl/features/normal_3d_omp.h> #include <pcl/features/principal_curvatures.h> #include <pcl/segmentation/sac_segmentation.h> #include <pcl/segmentation/extract_polygonal_prism_data.h> int main() { // 加载点云数据 pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>); pcl::io::loadPCDFile<pcl::PointXYZ>("input_cloud.pcd", *cloud); // 计算法线 pcl::NormalEstimationOMP<pcl::PointXYZ, pcl::Normal> ne; ne.setInputCloud(cloud); pcl::search::KdTree<pcl::PointXYZ>::Ptr tree(new pcl::search::KdTree<pcl::PointXYZ>); ne.setSearchMethod(tree); pcl::PointCloud<pcl::Normal>::Ptr cloud_normals(new pcl::PointCloud<pcl::Normal>); ne.setRadiusSearch(0.03); ne.compute(*cloud_normals); // 段落分割 pcl::PointIndices::Ptr inliers(new pcl::PointIndices); pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients); pcl::SACSegmentationFromNormals<pcl::PointXYZ, pcl::Normal> seg; seg.setOptimizeCoefficients(true); seg.setModelType(pcl::SACMODEL_NORMAL_PLANE); seg.setNormalDistanceWeight(0.1); seg.setMethodType(pcl::SAC_RANSAC); seg.setMaxIterations(100); seg.setDistanceThreshold(0.03); seg.setInputCloud(cloud); seg.setInputNormals(cloud_normals); seg.segment(*inliers, *coefficients); // 圆柱面提取 pcl::ExtractPolygonalPrismData<pcl::PointXYZ> prism; prism.setInputCloud(cloud); prism.setInputPlanarHull(cloud); prism.setHeightLimits(0.0, 1.0); // 设置圆柱体高度范围 pcl::PointIndices::Ptr cylinder_inliers(new pcl::PointIndices); prism.segment(*cylinder_inliers); // 提取圆柱面点云 pcl::PointCloud<pcl::PointXYZ>::Ptr cylinder_cloud(new pcl::PointCloud<pcl::PointXYZ>); pcl::ExtractIndices<pcl::PointXYZ> extract; extract.setInputCloud(cloud); extract.setIndices(cylinder_inliers); extract.setNegative(false); // 提取圆柱面内部的点云 extract.filter(*cylinder_cloud); // 保存结果 pcl::PCDWriter writer; writer.write<pcl::PointXYZ>("output_cylinder.pcd", *cylinder_cloud, false); return 0; } ``` 请注意,除了将 `setInputMesh` 替换为 `setInputPlanarHull` 外,其他代码保持不变。希望这可以解决你遇到的问题
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值