说明
Eigen库中的四元数Quaterniond相关问题,包括构造、及使用
构造
顺序是(w,x,y,z),w为实部,后三者为虚部
Quaterniond q1(0.35, 0.2, 0.3, 0.1), q2(-0.5, 0.4, -0.1, 0.2);
使用
q1.normalize();
q2.normalize();
Vector3d t1(0.3, 0.1, 0.1), t2(-0.1, 0.5, 0.3);
Vector3d p1(0.5, 0, 0.2);
Isometry3d T1w(q1), T2w(q2);
T1w.pretranslate(t1);
T2w.pretranslate(t2);
注:四元数使用之前需要归一化