原文作者:aircraft
知道旋转前后矩阵向量值 如何去求旋转矩阵R 的c++/c#代码???
因为需要用到矩阵处理库所以需要先配置
一、Eigen库的配置(VS2017)
然后在自己的VS工程属性中的这个附加包含进去
注意看清楚了 是D:\Dependencies\eigen-eigen\eigen-eigen; 前面部分是你们自己的路径 后面的这个eigen-eigen\eigen-eigen; 代表的意思解压是点击进去选择里面那个名字跟外面一样的
二、实现代码
#include #include#include"Eigen/Dense"#include"Eigen/LU"#include"Eigen/Core"
#define PI 3.1415926
double calculateAngle(const Eigen::Vector3d &vectorBefore, const Eigen::Vector3d &vectorAfter)
{doubleab, a1, b1, cosr;
ab= vectorBefore.x()*vectorAfter.x() + vectorBefore.y()*vectorAfter.y() + vectorBefore.z()*vectorAfter.z();
a1= sqrt(vectorBefore.x()*vectorBefore.x() + vectorBefore.y()*vectorBefore.y() + vectorBefore.z()*vectorBefore.z());
b1= sqrt(vectorAfter.x()*vectorAfter.x() + vectorAfter.y()*vectorAfter.y() + vectorAf