a1356467的博客

Eigen::Vector3d t = v; double angle = t.norm(); t = t.normalized(); Eigen::AngleAxisd rotation_vector(angle, t); Eigen::Isometry3d T = Eigen::Isometry3d::Identity(); T.rotate(rotation_vector); T.pretranslate(p); Eigen::Matri...