kinect - 在 ROS 中使用 kinect v2 根据颜色获取点云数据的质心

Question

我想使用 kinect v2 获取基于颜色的点云数据的质心。即使搜索了很长时间，我也找不到可以执行此任务的包。但由于这是一个普遍的问题，我认为应该有一个现有的包。

请帮忙。提前致谢！

Answer 1

如果您使用的是 PCL，您可以这样做

pcl::PointXYZRGB centroid;
pcl::computeCentroid(*cloud, centroid);

否则，它只是分数的平均值。例如：

                pcl::PointXYZI centroid;

                float x = 0, y = 0, z = 0;
                for (int k = 0; k < cloud->size(); k++)
                {
                   x += cloud->at(k).x;
                   y += cloud->at(k).y;
                   z += cloud->at(k).z;
                }
                centroid.x = x / (cloud->size() + 0.0);
                centroid.y = y / (cloud->size() + 0.0);
                centroid.z = z / (cloud->size() + 0.0);