该算法用于拟合点云中全部的平面。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,算法中止工做。排序
#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 ()) { }