C++ PCL 库：点云直线拟合与可视化 (RANSAC 算法)

#include #include <pcl/io/ply_io.h> #include <pcl/point_types.h> #include <pcl/visualization/pcl_visualizer.h> #include <pcl/sample_consensus/sac_model_line.h> #include <pcl/sample_consensus/ransac.h>

int main() { // 加载点云数据 pcl::PointCloudpcl::PointXYZ::Ptr cloud(new pcl::PointCloudpcl::PointXYZ); pcl::io::loadPLYFilepcl::PointXYZ("your_point_cloud.ply", *cloud);

// 创建一个 RANSAC 对象进行直线拟合
pcl::SampleConsensusModelLine<pcl::PointXYZ>::Ptr model(new pcl::SampleConsensusModelLine<pcl::PointXYZ>(cloud));
pcl::RandomSampleConsensus<pcl::PointXYZ> ransac(model);
ransac.setDistanceThreshold(0.01);  // 设置距离阈值
ransac.computeModel();

// 获取拟合的直线模型参数
Eigen::VectorXf model_coefficients;
ransac.getModelCoefficients(model_coefficients);

// 创建可视化对象并添加点云和直线
pcl::visualization::PCLVisualizer viewer("Point Cloud Viewer");
viewer.setBackgroundColor(0.0, 0.0, 0.0);
pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> color(cloud, 255, 255, 255);
viewer.addPointCloud<pcl::PointXYZ>(cloud, color, "cloud");
viewer.addLine<pcl::PointXYZ>(cloud->points[0], cloud->points[1], "line");

// 显示点云和直线
viewer.spin();

return 0;

}

请注意替换your_point_cloud.ply为你自己的点云文件路径。该代码使用了RANSAC算法进行直线拟合，并使用PCLVisualizer可视化对象可视化点云和直线。