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

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;