weixin_43389008的博客

norm() 返回向量的二范数，比如 norm(3.0,4.0) = 5.0。

由旋转矩阵和平移得到齐次变换矩阵1）Eigen::Matrix3d R;// Find your Rotation MatrixEigen::Vector3d T;// Find your translation VectorEigen::Matrix4d Trans; // Your Transformation MatrixTrans.setIdentity(); // Set to Identity to make bottom row of Matrix 0,0,0,1Tra..