opencv C++实现
#include <iostream>
#include <opencv2/opencv.hpp>
#include <opencv2/core.hpp>
int main()
{
double r_vec[3] = { -2.100418,-2.167796,0.273330 };
cv::Mat pr_vec(1, 3, CV_64FC1, r_vec);
std::cout << "pr_vec = " << pr_vec << std::endl;
cv::Mat pR_matrix;
cv::Rodrigues(pr_vec, pR_matrix);
std::cout << "pR_matrix = " << pR_matrix << std::endl;
system("pause");
return 0;
}
罗德里格斯公式(Rodriguez formula)是计算机视觉中的一大经典公式,在描述相机位姿的过程中很常用。公式:
在三维空间中,旋转矩阵