转置
Eigen::Matrix3d C;
C=A.transpose();//转置
逆矩阵
Eigen::Translation3f tl_btol(_tf_x, _tf_y, _tf_z); // tl: translation
Eigen::AngleAxisf rot_x_btol(_tf_roll, Eigen::Vector3f::UnitX()); // rot: rotation
Eigen::AngleAxisf rot_y_btol(_tf_pitch, Eigen::Vector3f::UnitY());
Eigen::AngleAxisf rot_z_btol(_tf_yaw, Eigen::Vector3f::UnitZ());
tf_btol_ = (tl_btol * rot_z_btol * rot_y_btol * rot_x_btol).matrix();
tf_ltob_ = tf_btol_.inverse();
平移
Eigen::Translation3f translation(x,y,z);