利用pcl点云库找到物体(鞋底)的上边缘
一、总体思路
1将点云按鞋底长度方向分成多个片段;2每个点云片段找到最高点;3将找到的最高点放到新的点云中显示
二、代码
for (float i = min.y; i < max.y; i=i+2.0)
{
for (size_t j = 0; j < cloud_final->points.size(); j++)
{
if (cloud_final->points[j].y >= i && cloud_final->points[j].y < i+2.0)
{
indexs.push_back(j);
}
}
pcl::copyPointCloud(*cloud_final, indexs,