PCL1.8.1 分割 - 区域增加

Region growing segmentation

该算法用于拟合点云中全部的平面。php

算法核心:该算法是基于点法线之间角度的比较,企图将知足平滑约束的相邻点合并在一块儿,以一簇点集的形式输出。每簇点集被认为是属于相同平面。ios

工做原理:区域增加是从有最小曲率值(curvature value)的点开始的。所以,咱们必须计算出全部曲率值,并对它们进行排序。这是由于曲率最小的点位于平坦区域,而从最平坦的区域增加能够减小区域的总数。如今咱们来具体描述这个过程:算法

1.点云中有未标记点,按照点的曲率值对点进行排序,找到最小曲率值点,并把它添加到种子点集;测试

2.对于每一个种子点,算法都会发现周边的全部近邻点。1)计算每一个近邻点与当前种子点的法线角度差(reg.setSmoothnessThreshold),若是差值小于设置的阈值,则该近邻点被重点考虑,进行第二步测试;2)该近邻点经过了法线角度差检验,若是它的曲率小于咱们设定的阈值(reg.setCurvatureThreshold),这个点就被添加到种子点集,即属于当前平面。spa

3.经过两次检验的点,被从原始点云去除。3d

4.设置最小点簇的点数min(reg.setMinClusterSize),最大点簇为max(reg.setMaxClusterSize)。code

4.重复1-3步,算法会生成点数在min和max的全部平面,并对不一样平面标记不一样颜色加以区分。orm

5.直到算法在剩余点中生成的点簇不能知足min,算法中止工做。排序

http://pointclouds.org/documentation/tutorials/region_growing_segmentation.php#region-growing-segmentationget

#include <pcl/segmentation/region_growing.h>
#include <pcl/features/normal_3d.h>
#include <pcl/visualization/cloud_viewer.h>
#include <iostream>
#include <vector>
#include <pcl/point_types.h>
#include <pcl/search/search.h>
#include <pcl/search/kdtree.h>

pcl::PointCloud<pcl::PointXYZ>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZ>);
pcl::PointCloud <pcl::Normal>::Ptr normals (new pcl::PointCloud <pcl::Normal>);

pcl::search::Search<pcl::PointXYZ>::Ptr tree (new pcl::search::KdTree<pcl::PointXYZ>);

pcl::RegionGrowing<pcl::PointXYZ, pcl::Normal> reg;
reg.setMinClusterSize (50);
reg.setMaxClusterSize (1000000);
reg.setSearchMethod (tree);
reg.setNumberOfNeighbours (30);
reg.setInputCloud (cloud);
//reg.setIndices (indices);
reg.setInputNormals (normals);
reg.setSmoothnessThreshold (3.0 / 180.0 * M_PI);
reg.setCurvatureThreshold (1.0);

std::vector <pcl::PointIndices> clusters;
reg.extract (clusters);


//以不一样颜色显示拟合的平面
pcl::PointCloud <pcl::PointXYZRGB>::Ptr colored_cloud = reg.getColoredCloud ();
pcl::visualization::CloudViewer viewer ("Cluster viewer");
viewer.showCloud(colored_cloud);
while (!viewer.wasStopped ())
{
}
相关文章
相关标签/搜索