使用 RANSAC 算法拟合 PCD 点云数据中多条直线的 C++ 代码

以下是一个使用 RANSAC 算法拟合多条直线的 C++ 代码示例：

#include <iostream>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.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>);
    pcl::io::loadPCDFile<pcl::PointXYZ>('input.pcd', *cloud);

    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);

    // 使用 RANSAC 拟合多条直线
    std::vector<pcl::PointCloud<pcl::PointXYZ>::Ptr> lines;
    while (inliers.size() > 0.5 * cloud->size()) {
        pcl::PointCloud<pcl::PointXYZ>::Ptr line(new pcl::PointCloud<pcl::PointXYZ>);
        for (int i = 0; i < inliers.size(); ++i) {
            line->push_back(cloud->points[inliers[i]]);
        }
        lines.push_back(line);

        // 从点云中移除内点
        pcl::PointCloud<pcl::PointXYZ>::Ptr remaining_cloud(new pcl::PointCloud<pcl::PointXYZ>);
        pcl::ExtractIndices<pcl::PointXYZ> extract;
        extract.setInputCloud(cloud);
        extract.setIndices(boost::make_shared<std::vector<int>>(inliers));
        extract.setNegative(true);
        extract.filter(*remaining_cloud);
        cloud = remaining_cloud;

        // 更新 RANSAC 模型
        model->setInputCloud(cloud);
        ransac.setInputCloud(cloud);
        ransac.computeModel();
        ransac.getInliers(inliers);
    }

    // 打印拟合直线的参数
    for (int i = 0; i < lines.size(); ++i) {
        pcl::PointXYZ first_point = lines[i]->points.front();
        pcl::PointXYZ last_point = lines[i]->points.back();
        std::cout << 'Line ' << i+1 << ': (' << first_point.x << ', ' << first_point.y << ', ' << first_point.z << ') to (' << last_point.x << ', ' << last_point.y << ', ' << last_point.z << ')' << std::endl;
    }

    return 0;
}

请注意，这只是一个示例代码，你需要根据自己的实际情况进行修改和适配。代码假设输入点云数据存储在名为'input.pcd'的文件中，你可以根据实际文件名进行修改。代码使用了 PCL 库来处理点云数据，因此你需要确保你已经正确安装了 PCL 库并在编译时链接了相关的 PCL 库文件。