admin管理员组

文章数量:1122850

I have 2 sets of pointcloud to be registed, common results of icp is for 6dof, Is it possible to constraint the registration to 5dof(RX, RY, TX, TY, TZ)? I tried to implement my own warp_point_rigid_RxRyT.h, which is a modification of <pcl/registration/warp_point_rigid_6d.h>

The modification is as below:

void setParam(const VectorX& p) override { assert(p.rows() == this->getDimension());

   // Copy the rotation and translation components
   transform_matrix_.setZero();
   transform_matrix_(0, 3) = p[0];
   transform_matrix_(1, 3) = p[1];
   transform_matrix_(2, 3) = p[2];
   transform_matrix_(3, 3) = 1;

  // Compute w from the unit quaternion
  Eigen::Quaternion<Scalar> q(0, p[3], p[4], 0);
  q.w() = static_cast<Scalar>(std::sqrt(1 - q.dot(q)));
  q.normalize();
  transform_matrix_.template topLeftCorner<3, 3>() = q.toRotationMatrix();

}

It doesn't work, the icp result is still 6dof.

本文标签：

版权声明：本文标题：c++ - icp registration with constraint degree of freedom( RX, RY, TX, TY, TZ ) - Stack Overflow 内容由网友自发贡献，该文观点仅代表作者本人， 转载请联系作者并注明出处：http://www.betaflare.com/web/1736186209a1908959.html， 本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如发现本站有涉嫌抄袭侵权/违法违规的内容，一经查实，本站将立刻删除。