如何找到点云中物体的质心？

Question

谁能告诉我如何在点云中找到物体的质心？。 我还没有尝试过任何代码，因为我对如何去做一无所知。

Answer 1

如果你有点位置，你应该能够对 x 和 y 位置进行平均。

int x = 0; y = 0;
for ( i = 0; i < num_pts; i++ )
{
    x += pt[i].x;
    y += pt[i].y;
}
centroid.x = x / num_pts;
centroid.y = y / num_pts;