基于pcl181库计算点云ply文件内各点到已知直线参数的距离的C++代码

以下是一个基于pcl1.8.1库计算点云ply文件内各点到已知直线参数的距离的C++代码的示例：

#include <iostream>
#include <pcl/io/ply_io.h>
#include <pcl/point_types.h>
#include <pcl/filters/voxel_grid.h>
#include <pcl/ModelCoefficients.h>
#include <pcl/filters/project_inliers.h>

int main()
{
    // 加载点云数据
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::io::loadPLYFile<pcl::PointXYZ>("input.ply", *cloud);

    // 创建一个直线模型的系数对象
    pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients());
    coefficients->values.resize(6);
    coefficients->values[0] = 1.0;  // 直线的方向向量
    coefficients->values[1] = 0.0;
    coefficients->values[2] = 0.0;
    coefficients->values[3] = 0.0;  // 直线上的一点
    coefficients->values[4] = 0.0;
    coefficients->values[5] = 0.0;

    // 创建一个投影滤波器
    pcl::ProjectInliers<pcl::PointXYZ> proj;
    proj.setModelType(pcl::SACMODEL_LINE);
    proj.setInputCloud(cloud);
    proj.setModelCoefficients(coefficients);
    proj.filter(*cloud);

    // 计算每个点到直线的距离
    std::vector<double> distances;
    for (const auto& point : cloud->points) {
        double distance = pcl::pointToLineDistance(point, *coefficients);
        distances.push_back(distance);
    }

    // 输出每个点到直线的距离
    for (int i = 0; i < distances.size(); ++i) {
        std::cout << "Point " << i << " distance to line: " << distances[i] << std::endl;
    }

    return 0;
}

请确保已经安装了pcl1.8.1库，并将代码中的input.ply替换为你的点云文件的路径。这段代码加载点云数据，创建一个直线模型的系数对象，然后通过投影滤波器将点云投影到直线上，最后计算每个点到直线的距离并输出结果