C++ 点云 PCD 文件 RANSAC 直线拟合及可视化

以下是使用 PCL 库进行点云 RANSAC 直线拟合并可视化的示例代码：

#include <iostream>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/visualization/cloud_viewer.h>
#include <pcl/sample_consensus/ransac.h>
#include <pcl/sample_consensus/sac_model_line.h>

int main ()
{
  // 读取点云数据
  pcl::PointCloud<pcl::PointXYZ>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZ>);
  if (pcl::io::loadPCDFile<pcl::PointXYZ> ('your_point_cloud.pcd', *cloud) == -1)
  {
    PCL_ERROR ('Couldn't read file test_pcd.pcd \n');
    return (-1);
  }

  // 创建 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);
  std::cout << 'Line coefficients: ' << model_coefficients << std::endl;

  // 可视化点云和拟合直线
  pcl::PointCloud<pcl::PointXYZ>::Ptr inliers (new pcl::PointCloud<pcl::PointXYZ>);
  ransac.getInliers (inliers);
  pcl::visualization::PCLVisualizer viewer ('Point Cloud Viewer');
  viewer.addPointCloud<pcl::PointXYZ> (cloud, 'cloud');
  viewer.addPointCloud<pcl::PointXYZ> (inliers, 'inliers');
  viewer.spin ();

  return 0;
}

请将 'your_point_cloud.pcd' 替换为您的点云文件路径。该代码首先读取点云文件，然后创建 RANSAC 对象，并设置点到直线的距离阈值。然后，使用 RANSAC 计算拟合直线的模型，并获取直线的参数。最后，将点云和拟合直线可视化。