PCL检测点云边界

一、分享给有需要的人,代码质量勿喷

void boundary(const std::string &pathPC, const std::string &pathBoundary,
	const double &rNormal, const double &rBoundary, const double &thrAngle)
{
	//read point cloud
	pcl::PointCloud<pcl::PointXYZ>::Ptr pc(new pcl::PointCloud<pcl::PointXYZ>);
	pcl::io::loadPCDFile(pathPC, *pc);

	/* normal */
	pcl::NormalEstimation<pcl::PointXYZ, pcl::Normal> normalEst;
	pcl::search::KdTree<pcl::PointXYZ>::Ptr kd_tree(new pcl::search::KdTree<pcl::PointXYZ>);
	normalEst.setInputCloud(pc);
	normalEst.setSearchMethod(kd_tree);
	normalEst.setRadiusSearch(rNormal);
	pcl::PointCloud<pcl::Normal>::Ptr pcNormal(new pcl::PointCloud<pcl::Normal>);
	normalEst.compute(*pcNormal);

	/* boundary */
	pcl::BoundaryEstimation<pcl::PointXYZ, pcl::Normal, pcl::Boundary> boundaryEst;
	boundaryEst.setInputCloud(pc);
	boundaryEst.setInputNormals(pcNormal);
	boundaryEst.setRadiusSearch(rBoundary);
	boundaryEst.setAngleThreshold(thrAngle);
	boundaryEst.setSearchMethod(kd_tree);
	pcl::PointCloud<pcl::Boundary> boundaries;
	boundaryEst.compute(boundaries);

	pcl::PointCloud<pcl::PointXYZ>::Ptr pcBoundary(new pcl::PointCloud<pcl::PointXYZ>);
	for (int i = 0; i < pc->points.size(); i++)
	{
		if (boundaries[i].boundary_point > 0)
		{
			pcBoundary->push_back(pc->points[i]);
		}
	}

	//write boundary
	pcl::io::savePCDFileASCII(pathBoundary, *pcBoundary);
}

二、效果

rBoundary=0.5  thrAngle=30
rBoundary=0.5  thrAngle=60
rBoundary=0.5  thrAngle=90

rBoundary=0.2  thrAngle=60
rBoundary=0.5  thrAngle=60
rBoundary=1  thrAngle=60
  • 4
    点赞
  • 13
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 2
    评论
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

累了就要打游戏

把我养胖,搞代码

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值