基于pcl库设置添加直线的长度的c++代码

以下是一个基于pcl库的C++代码示例，用于根据点云数据添加直线的长度：

#include <iostream>
#include <pcl/point_types.h>
#include <pcl/io/pcd_io.h>
#include <pcl/visualization/pcl_visualizer.h>

typedef pcl::PointXYZ PointT;

int main()
{
    pcl::PointCloud<PointT>::Ptr cloud(new pcl::PointCloud<PointT>);
    pcl::io::loadPCDFile("input_cloud.pcd", *cloud);

    // 假设直线的起点和终点分别为点云中的第一个点和最后一个点
    PointT start = cloud->points[0];
    PointT end = cloud->points[cloud->size() - 1];

    // 计算直线的长度
    double length = pcl::euclideanDistance(start, end);

    std::cout << "直线长度: " << length << std::endl;

    // 可视化点云和直线
    pcl::visualization::PCLVisualizer viewer("PointCloud Viewer");
    viewer.setBackgroundColor(0, 0, 0);
    viewer.addPointCloud(cloud, "cloud");

    // 添加直线
    viewer.addLine<PointT>(start, end, 255, 0, 0, "line");

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

    return 0;
}

请确保已安装pcl库，并将点云数据保存为名为input_cloud.pcd的文件