基于pcl库输出点云ply文件内已知kruskal最小生成树result内存储的构成每一条边需要的两个点且若这两点与点p相同则输出这条边的c++代码

假设已知的kruskal最小生成树结果存储在名为result的容器中，其中每个元素表示一条边，包含两个点的索引。现在我们需要输出构成每一条边的两个点，并判断这两个点是否与给定的点p相同。以下是一个可能的实现：

#include <iostream>
#include <fstream>
#include <vector>
#include <pcl/point_types.h>
#include <pcl/io/ply_io.h>

void outputEdges(const std::vector<std::pair<int, int>>& result, const pcl::PointCloud<pcl::PointXYZ>::Ptr& cloud, const pcl::PointXYZ& p, const std::string& filename) {
    std::ofstream outfile(filename);
    
    if (!outfile) {
        std::cerr << "Error opening file: " << filename << std::endl;
        return;
    }
    
    outfile << "ply\n";
    outfile << "format ascii 1.0\n";
    outfile << "element vertex " << cloud->size() << "\n";
    outfile << "property float x\n";
    outfile << "property float y\n";
    outfile << "property float z\n";
    outfile << "element edge " << result.size() << "\n";
    outfile << "property int vertex1\n";
    outfile << "property int vertex2\n";
    outfile << "end_header\n";
    
    for (const auto& point : *cloud) {
        outfile << point.x << " " << point.y << " " << point.z << "\n";
    }
    
    int edgeCount = 0;
    for (const auto& edge : result) {
        int index1 = edge.first;
        int index2 = edge.second;
        
        if (cloud->points[index1] == p || cloud->points[index2] == p) {
            outfile << index1 << " " << index2 << "\n";
            edgeCount++;
        }
    }
    
    std::cout << "Wrote " << edgeCount << " edges to " << filename << std::endl;
    
    outfile.close();
}

int main() {
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
    pcl::io::loadPLYFile<pcl::PointXYZ>("input.ply", *cloud);
    
    std::vector<std::pair<int, int>> result;
    // 假设result已经被填充
    
    pcl::PointXYZ p; // 给定的点p
    // 假设已经为p赋值
    
    outputEdges(result, cloud, p, "output.ply");
    
    return 0;
}

上述代码中的outputEdges函数用于输出点云PLY文件，其中仅包含与给定点p相连的边。这个函数首先打开输出文件，然后按照PLY文件的格式写入点云数据和边数据。在写入边数据时，我们遍历result中的每一条边，判断构成边的两个点是否与p相同，若是则将边的索引写入文件。最后输出写入的边的数量，并关闭文件。

在main函数中，我们首先加载输入的PLY文件到点云cloud中，然后定义了一个result容器用于存储kruskal最小生成树的结果。接下来为给定的点p赋值，然后调用outputEdges函数输出结果到名为output.ply的文件中。

请注意，在运行代码之前，需要确保已经安装了pcl库，并且将输入的PLY文件命名为input.ply。输出的PLY文件将包含与给定点p相连的边的索引