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

下面是一个简单的 C++ 代码示例，用于将点云 PCD 文件进行 RANSAC 直线拟合，并将直线内点可视化。

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

int main(int argc, char** argv)
{
    // 加载点云数据
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::PCDReader reader;
    reader.read<pcl::PointXYZ>( 'input.pcd', *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();

    // 获取拟合的直线内点索引
    std::vector<int> inliers;
    ransac.getInliers(inliers);

    // 创建可视化对象
    pcl::visualization::PCLVisualizer viewer( 'RANSAC Line Fitting' );
    viewer.addPointCloud<pcl::PointXYZ>(cloud, 'cloud' );

    // 创建直线的两个端点
    pcl::PointXYZ p1, p2;
    model->computeInliersCoefficients(inliers, model->getModelCoefficients(), p1, p2);

    // 可视化直线
    viewer.addLine<pcl::PointXYZ>(p1, p2, 1.0, 0.0, 0.0, 'line' );

    while (!viewer.wasStopped())
    {
        viewer.spinOnce();
    }

    return 0;
}

在上述代码中，我们首先加载点云数据，然后创建一个 RANSAC 对象并设置距离阈值。接下来，我们通过调用 computeModel() 方法执行 RANSAC 拟合，并通过 getInliers() 方法获取拟合的直线内点索引。然后，我们创建一个 PCLVisualizer 对象来可视化点云和拟合的直线。最后，我们通过调用 addLine() 方法将直线添加到可视化对象中，并通过调用 spinOnce() 方法显示结果。

请确保在运行代码之前安装 PCL 库，并将 input.pcd 替换为您自己的点云文件路径。