C++ 代码实现点云 PLY 数据等距切片

以下是一个对点云 PLY 数据进行等距切片的 C++ 代码示例：

#include <iostream>
#include <fstream>
#include <vector>

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

void slicePointCloud(const std::string& inputFile, const std::string& outputFile, float minZ, float maxZ, float sliceThickness) {
    std::ifstream ifs(inputFile, std::ios::binary);
    std::ofstream ofs(outputFile, std::ios::binary);

    std::string line;
    int numPoints = 0;
    std::vector<Point> points;

    // 读取 PLY 文件头部
    while (std::getline(ifs, line)) {
        if (line.find('element vertex') != std::string::npos) {
            numPoints = std::stoi(line.substr(line.find_last_of(' ') + 1));
        }
        if (line == 'end_header') {
            break;
        }
    }

    // 读取点云数据
    points.resize(numPoints);
    ifs.read(reinterpret_cast<char*>(points.data()), numPoints * sizeof(Point));

    // 进行切片
    std::vector<Point> slicedPoints;
    for (const auto& point : points) {
        if (point.z >= minZ && point.z <= maxZ) {
            auto numSlices = static_cast<int>((point.z - minZ) / sliceThickness);
            auto sliceZ = minZ + numSlices * sliceThickness;
            Point slicedPoint = {point.x, point.y, sliceZ};
            slicedPoints.push_back(slicedPoint);
        }
    }

    // 写入切片后的点云数据
    int numSlicedPoints = slicedPoints.size();
    ofs << 'ply\n';
    ofs << 'format binary_little_endian 1.0\n';
    ofs << 'element vertex ' << numSlicedPoints << '\n';
    ofs << 'property float x\n';
    ofs << 'property float y\n';
    ofs << 'property float z\n';
    ofs << 'end_header\n';
    ofs.write(reinterpret_cast<const char*>(slicedPoints.data()), numSlicedPoints * sizeof(Point));
}

int main() {
    std::string inputFile = 'input.ply';
    std::string outputFile = 'output.ply';
    float minZ = 0.0f;
    float maxZ = 1.0f;
    float sliceThickness = 0.1f;

    slicePointCloud(inputFile, outputFile, minZ, maxZ, sliceThickness);

    return 0;
}

该代码示例假设输入的点云 PLY 文件格式为二进制格式，其中包含一个名为'vertex'的元素，每个顶点包含 3 个浮点数属性表示坐标 (x, y, z)。代码首先读取 PLY 文件头部，获取顶点数量，然后读取点云数据。接下来，代码遍历点云中的每个点，如果点的 z 坐标在 [minZ, maxZ] 范围内，则计算该点在切片中的位置，然后将切片后的点添加到新的点云数据中。最后，代码将切片后的点云数据写入输出 PLY 文件。