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

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值