一、从旋转矩阵转四元数 旋转矩阵转四元数是一个相对简单的过程。 #include <Eigen/Dense> Eigen::Matrix3d rotation_matr…
一、四元数转欧拉角表 下面是一个关于四元数转欧拉角的表格。这个表格展示了每个方向的旋转,四元数表示和欧拉角表示。 方向 四元数表示 欧拉角表示 X轴 [cos(θ/2), sin(…