QT内存映射读取点云数据

pcl::PointCloud<pcl::PointXYZRGBA>::Ptr txtRead(std::string file_name)
{
	pcl::PointCloud<pcl::PointXYZRGBA>::Ptr data(new pcl::PointCloud< pcl::PointXYZRGBA>);
	pcl::PointXYZRGBA f_xyz;
	QString str = QString::fromStdString(file_name);
	QFile file(str);
	if (!file.open(QFile::ReadOnly | QIODevice::Text))
		return 0;
	uchar* fpr = file.map(0, file.size());
	char *s = strdup((char*)fpr);
	char *substr;
	char *token = NULL;
	char *next = NULL;
	float point[3];
	while (substr = strtok_s(s,"\n", &next))
	{
		s = next;
		for (int i = 0; i < 3; i++)
		{
			char *lineSubStr = strtok_s(substr, " ", &token);
			substr = token;
			point[i] = atof(lineSubStr);
		}
		f_xyz.x = point[0];
		f_xyz.y = point[1];
		f_xyz.z = point[2];
		data->points.push_back(f_xyz);
	}
	file.close();
	data->height = data->points.size();
	data->width = 1;
	return data;
}

 

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值