当前位置：首页 > ds >正文

pcl求平面点云的边界凸包点

ds 2025/8/21 11:15:48

基本流程

1，读入点云，并去除无效点

2，拟合平面

3，去除离平面距离较远的点

4，对点云进行平面投影

5，进行convex_hull运算

初学者，暂时不知道能用来干嘛。练手还是非常不错的！

#define _CRT_SECURE_NO_WARNINGS
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>
#include <pcl/io/ply_io.h>
#include <pcl/io/pcd_io.h>
#include <pcl/common/centroid.h>
#include "tolls.h"
#include <pcl/common/angles.h>
#include<pcl/common/eigen.h>
#include<pcl/common/common_headers.h>
#include<pcl/common/common.h>
#include<pcl/filters/random_sample.h>
#include<pcl/filters/uniform_sampling.h>
#include<Eigen/Dense>
#include<pcl/features/moment_of_inertia_estimation.h>
#include<pcl/common/transforms.h>
#include<pcl/features/normal_3d.h>
#include<pcl/visualization//pcl_visualizer.h>
#include<Eigen/Dense>
#include<pcl/filters/grid_minimum.h>
#include<pcl/segmentation/region_growing_rgb.h>
#include<pcl/segmentation/sac_segmentation.h>
#include<pcl/filters/model_outlier_removal.h>
#include<pcl/filters/project_inliers.h>
#include<pcl/surface/convex_hull.h>using namespace std;
int main() 
{pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);string filename = "D:\\Desktop\\pacl_learning\\cloud\\test1.pcd";pcl::io::loadPCDFile(filename, *cloud);cout << cloud->points.size() << endl;//show_cloud_xyz(cloud);//先去除无效点vector<int> a;pcl::removeNaNFromPointCloud(*cloud, *cloud,a );//拟合平面pcl::ModelCoefficients::Ptr coffe(new pcl::ModelCoefficients);pcl::SACSegmentation<pcl::PointXYZ> seg;seg.setInputCloud(cloud);seg.setModelType(pcl::SACMODEL_PLANE);seg.setMethodType(pcl::SAC_RMSAC);seg.setMaxIterations(100);pcl::PointIndices::Ptr index(new pcl::PointIndices);seg.segment(*index, *coffe);cout <<  coffe->values[0] <<"  " << coffe->values[1] << "  " << coffe->values[2] << "  " << coffe->values[3] << "  " << endl;//去除偏远的点pcl::ModelOutlierRemoval<pcl::PointXYZ> model_re;model_re.setInputCloud(cloud);model_re.setModelCoefficients(*coffe);model_re.setModelType(pcl::SACMODEL_PLANE);model_re.setThreshold(0.1);model_re.filter(a);cout << a.size() << endl;//提取目标点pcl::PointCloud<pcl::PointXYZ>::Ptr cloud1(new pcl::PointCloud<pcl::PointXYZ>);for (int i=0;i<a.size();i++){cloud1->push_back(cloud->points[a[i]]);}cout << cloud1->points.size() << endl;//开始对这些点进行投影 cloud1pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_proj(new pcl::PointCloud<pcl::PointXYZ>);pcl::ProjectInliers<pcl::PointXYZ> proj;proj.setInputCloud(cloud1);proj.setModelType(pcl::SACMODEL_PLANE);proj.setModelCoefficients(coffe);proj.filter(*cloud_proj);//show_cloud_xyz(cloud_proj);//开始计算凸包pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_hull(new pcl::PointCloud<pcl::PointXYZ>);pcl::ConvexHull<pcl::PointXYZ> con_hull;con_hull.setInputCloud(cloud_proj);con_hull.setDimension(2);  //点云平面投影后，这里必须用2维，三维会报错的con_hull.reconstruct(*cloud_hull);cout << cloud_hull->points.size() << endl;//show_cloud_xyz(cloud_hull); 自己封装 的算子return 0;}

查看全文

http://www.xdnf.cn/news/18454.html