如何使用PCL库从点云数据中获取协方差矩阵

Question

我想要一个可以使用PCL从点云数据中获取协方差矩阵的示例代码。

我查看了PCL文档，发现了计算协方差的代码：

// Placeholder for the 3x3 covariance matrix at each surface patch
Eigen::Matrix3f covariance_matrix;
// 16-bytes aligned placeholder for the XYZ centroid of a surface patch
Eigen::Vector4f xyz_centroid;
// Estimate the XYZ centroid
compute3DCentroid (cloud, xyz_centroid);
// Compute the 3x3 covariance matrix
computeCovarianceMatrix (cloud, xyz_centroid, covariance_matrix); 

Answer 1

这是直接的，但我想你需要更多的阅读文档/教程：）

1-加载PCD文件，例如：

pcl::PointCloud<pcl::PointXYZ>::Ptr cloud (new pcl::PointCloud<pcl::PointXYZ> ());
pcl::io::loadPCDFile("c:pathpcdfile.pcd",*cloud)

2-计算质心：

Eigen::Vector4f xyz_centroid;
compute3DCentroid (cloud, xyz_centroid);

3-计算协方差

Eigen::Matrix3f covariance_matrix;
computeCovarianceMatrix (cloud, xyz_centroid, covariance_matrix);