hust_twj 发表于 2015-4-7 08:51
您好,我也是刚做这个工作。如果已经得到了RT矩阵,怎么匹配点云数据呢?不知道用什么具体方法实现,求指 ...
//1. 如,前后两个点云分别定义为:
pcl::PointCloud<pcl::PointXYZ>::Ptr input_cloud_ptr;
pcl::PointCloud<pcl::PointXYZ>::Ptr output_cloud_ptr;
//2.点云的赋值操作
...
//3.变换矩阵的定义与赋值
Eigen::Matrix4f trans_matrix_RT = Eigen::Matrix4f::Identity(); //定义4*4单位阵
trans_matrix_RT(0,0)=1;
trans_matrix_RT(0,1)=1;
trans_matrix_RT(0,2)=1;
trans_matrix_RT(1,0)=1;
trans_matrix_RT(1,0)=1;
...
trans_matrix_RT(3,3)=1;
//4. 点云的RT变换
pcl::transformPointCloud (* input_cloud_ptr,*output_cloud_ptr, trans_matrix_RT); |