C++ 点云两点距离计算函数示例

下面是一个求取点云中两点之间距离的 C++ 函数的示例代码：

#include <iostream>
#include <cmath>

struct Point {
    double x;
    double y;
    double z;
};

double distance(const Point& p1, const Point& p2) {
    double dx = p2.x - p1.x;
    double dy = p2.y - p1.y;
    double dz = p2.z - p1.z;
    return std::sqrt(dx*dx + dy*dy + dz*dz);
}

int main() {
    Point p1 = {1.0, 2.0, 3.0};
    Point p2 = {4.0, 5.0, 6.0};
    double dist = distance(p1, p2);
    std::cout << 'Distance between p1 and p2 is: ' << dist << std::endl;
    return 0;
}

这个函数接受两个点的坐标作为参数，并返回它们之间的距离。首先，我们计算出两个点在 x、y 和 z 轴上的差值，然后使用勾股定理计算出两点之间的距离。在主函数中，我们创建了两个点 p1 和 p2，并调用 distance 函数计算它们之间的距离。最后，将结果打印出来。