随手笔记——Eigen库中的四元数Quaterniond相关注意问题

本文介绍了Eigen库中四元数Quaterniond的构造方法,如(w,x,y,z)顺序,以及使用技巧,包括四元数的归一化和在Isometry3d框架下的预翻译操作。示例代码展示了如何创建和操作四元数进行3D空间变换。

随手笔记——Eigen库中的四元数Quaterniond相关问题

说明

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);
注:四元数使用之前需要归一化

Eigen是一个C++的线性代数,它提供了对四元数的支持。在Eigen中,四元数是以Quaternion类的形式表示的。下面是使用Eigen进行四元数操作的示例代码: ```c++ #include <Eigen/Dense> #include <iostream> using namespace Eigen; int main() { // 创建一个四元数对象 Quaterniond q(1, 0, 0, 0); // w, x, y, z // 输出四元数对象的实部和虚部 std::cout << "Real part: " << q.w() << std::endl; std::cout << "Imaginary part: " << q.vec().transpose() << std::endl; // 旋转一个向量 Vector3d v(1, 0, 0); Vector3d v_rotated = q * v * q.inverse(); std::cout << "Rotated vector: " << v_rotated.transpose() << std::endl; // 将旋转轴和旋转角度转换为四元数 Vector3d axis(0, 0, 1); double angle = M_PI / 2; Quaterniond q_axis_angle(cos(angle / 2), sin(angle / 2) * axis.x(), sin(angle / 2) * axis.y(), sin(angle / 2) * axis.z()); // 两个四元数的乘积等于它们对应的旋转的复合 Quaterniond q_combined = q * q_axis_angle; std::cout << "Combined quaternion: " << q_combined.w() << " " << q_combined.vec().transpose() << std::endl; // 将四元数转换为旋转矩阵 Matrix3d R = q.toRotationMatrix(); std::cout << "Rotation matrix: " << std::endl << R << std::endl; return 0; } ``` 这个示例代码中,我们创建了一个四元数对象q,并输出了它的实部和虚部。然后我们将一个向量v绕q旋转,并输出旋转后的向量。接着我们将一个旋转轴和一个旋转角度转换为一个四元数对象q_axis_angle,并将两个四元数的乘积q_combined输出。最后,我们将四元数对象q转换为一个旋转矩阵R,并输出这个矩阵。
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
红包 添加红包
表情包 插入表情
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值