笔记:Eigen中四元数和旋转矩阵的运算
Eigen中四元数和旋转矩阵的运算四元数转为旋转矩阵使用前必须归一化,否则可能导致旋转矩阵不正交// //test quaerniond// Eigen::Quaterniond q_1(0.7,0.6,0.5,0.7);// Eigen::Quaterniond q_2(0.8,0.9,0.5,0.7);// Eigen::Quaterniond q_3,q_4;// Eigen::Matrix3d R_1 = q_1.normalized().toRotatio
原创
2021-04-01 16:32:14 ·
783 阅读 ·
0 评论