写一段以已知点p为起点的对点云ply文件欧式聚类的c++代码

以下是一个以已知点p为起点的对点云ply文件进行欧式聚类的C++代码示例：

#include <iostream>
#include <fstream>
#include <vector>
#include <math.h>

struct Point {
    float x, y, z;
};

// 计算两点之间的欧氏距离
float euclideanDistance(Point p1, Point p2) {
    float dx = p1.x - p2.x;
    float dy = p1.y - p2.y;
    float dz = p1.z - p2.z;
    return sqrt(dx*dx + dy*dy + dz*dz);
}

// 使用欧氏距离对点云进行聚类
void euclideanClustering(std::vector<Point> points, Point p, float distanceThreshold, std::vector<std::vector<Point>>& clusters) {
    std::vector<bool> visited(points.size(), false); // 标记点是否已被访问

    std::vector<Point> cluster; // 当前聚类
    cluster.push_back(p);

    for (int i = 0; i < cluster.size(); i++) {
        Point currentPoint = cluster[i];

        for (int j = 0; j < points.size(); j++) {
            if (!visited[j]) {
                float distance = euclideanDistance(currentPoint, points[j]);
                if (distance <= distanceThreshold) {
                    visited[j] = true;
                    cluster.push_back(points[j]);
                }
            }
        }
    }

    clusters.push_back(cluster);
}

int main() {
    std::ifstream file("point_cloud.ply");

    std::vector<Point> points;
    std::string line;
    while (std::getline(file, line)) {
        if (line == "end_header") {
            break;
        }
    }

    while (std::getline(file, line)) {
        Point point;
        std::istringstream iss(line);
        iss >> point.x >> point.y >> point.z;
        points.push_back(point);
    }

    Point p = { 1.0, 2.0, 3.0 }; // 已知起点

    float distanceThreshold = 0.1; // 聚类距离阈值

    std::vector<std::vector<Point>> clusters;
    euclideanClustering(points, p, distanceThreshold, clusters);

    // 输出聚类结果
    for (int i = 0; i < clusters.size(); i++) {
        std::cout << "Cluster " << i + 1 << ":" << std::endl;
        for (int j = 0; j < clusters[i].size(); j++) {
            std::cout << "(" << clusters[i][j].x << ", " << clusters[i][j].y << ", " << clusters[i][j].z << ")" << std::endl;
        }
        std::cout << std::endl;
    }

    return 0;
}

请注意，上述代码仅提供了一个简单的示例，用于演示如何使用欧氏距离对点云进行聚类。实际应用中，您可能需要根据具体需求进行适当的调整和优化。