c++ - 使用 Eigen 在 C++ 中的不同参考中表达向量和方向
问题描述
假设我有三个参考(A、B 和 C)
我知道以下价值观:
- B 在 A 中的位置(作为 Eigen::Vector3d)
- B 在 A 中的方向(作为 Eigen::Quaterniond)
- C 在 B 中的位置(作为 Eigen::Vector3d)
- C 在 B 中的方向(作为 Eigen::Quaterniond)
如何使用 C++ 和 Eigen 在 C 中找到 A 的位置和方向?
Eigen::Vector3d p_B_in_A = Eigen::Vector3d(...);
Eigen::Quaterniond q_B_in_A = Eigen::Quaterniond(...);
Eigen::Vector3d p_C_in_B = Eigen::Vector3d(...);
Eigen::Quaterniond q_C_in_B = Eigen::Quaterniond(...);
Eigen::Vector3d p_A_in_C = ???
Eigen::Quaterniond q_A_in_C = ???
解决方案
我以以下代码为例回答我自己的问题:
Eigen::Affine3d B2A = Eigen::Affine3d::Identity();
B2A.translation() << 2 , -1 , 1;
B2A.linear() << std::sqrt(2)/2, 0, std::sqrt(2)/2,
-std::sqrt(2)/2, 0, std::sqrt(2)/2,
0 , -1, 0;
Eigen::Affine3d C2B = Eigen::Affine3d::Identity();
C2B.translation() << 0, 1, 3*sqrt(2);
C2B.linear() << 1, 0, 0,
0,-1, 0,
0, 0,-1;
Eigen::Affine3d A2C = C2B.inverse() * B2A.inverse();
// At this point, the orientation of A in C can be found in
// A2C.linear() as a 3x3 rotation matrix. the position of A
// in C can be found in A2C.translation() as a Vector3d.
B2A表示B在A帧中的位置和方向。同理,C2B 表示 B 在 C 中的位置和方向。通过对两个变换求逆,可以找到 A 在 C 中的位置和方向。使用 Eigen 中的Affine对于进行空间变换以及组合平移和旋转非常有用。
推荐阅读
- java - 如何通过跳过前 3 行从文件中读取和添加对象?
- java - 使用java将数据插入mongodb
- amazon-web-services - 尝试设置 SES 以将事件发布到 SNS 时引发错误
- libreoffice - 如何在文档中插入键盘按键图形表示?
- mysql - 仅在 MacOS 上查询期间丢失与 MySQL 服务器的连接
- python - 列出连接到 django-channels 组的用户(频道 1.x)
- django - 清单:行:1,列:1,Chrome 浏览器上的语法错误
- javascript - 如何在云消息Android中获取Ref的孩子?
- php - 如何使用 preg_replace 更改 url 中的参数
- java - 为什么我不能创建新颜色