ros eigen计算两个向量在xy平面的夹角

在ROS中，可以使用Eigen库来计算两个向量在xy平面的夹角。具体步骤如下：

1. 导入Eigen库：

#include <Eigen/Dense>

2. 定义两个向量：

Eigen::Vector3d vector1(x1, y1, z1);
Eigen::Vector3d vector2(x2, y2, z2);

其中，(x1, y1, z1)和(x2, y2, z2)分别是两个向量的坐标。

3. 将两个向量投影到xy平面上：

vector1.z() = 0;
vector2.z() = 0;

将向量的z坐标设为0，即可将向量投影到xy平面上。

4. 计算两个向量的夹角：

double angle = vector1.normalized().dot(vector2.normalized());
angle = acos(angle) * 180.0 / M_PI;

首先，通过normalized()函数将两个向量归一化，然后使用dot()函数计算两个向量的点积，最后使用acos()函数计算夹角的弧度值，并将其转换为角度值。

最终，变量angle即为两个向量在xy平面的夹角