У меня есть пара проблем с собственными функциями OpenCV для формул PnP и Rodrigues. Я думаю, что это связано с cv::solvePnPRansac()
cv::Mat w = cv::Mat::zeros(3,1,CV_32FC1);
cv::Mat t = cv::Mat::zeros(3,1,CV_32FC1);
std::vector<float> distortion = {0,0,0,0};
std::vector<cv::Point3f> tmp1 = eig_vec_to_cv3(pts);
std::vector<cv::Point2f> tmp2 = eig_vec_to_cv2(pixels);
cv::solvePnPRansac(tmp1, tmp2, eig_mat_2_cv(K),distortion, w, t,false, 100, 2.0f);
cv::Mat R_ = cv::Mat::zeros(3,3,CV_32FC1);
cv::Rodrigues(w,R_);
std::cout<<"R_"<<std::endl;
std::cout<<R_<<std::endl;
std::cout<<R_.at<float>(0,0)<<std::endl;
Для std::cout<<R_<<std::endl
это выглядит нормально, но R_.at<float>(0,0)
дает номер tra sh, как память не выделяется. То же самое относится к w
и t
.
Однако, если я сделаю так:
cv::Mat w_ = cv::Mat(3,1,cv_32FC1);
w.at<float>(0,0) = 0.2;
w.at<float>(0,1) = 0.4;
w.at<float>(0,2) = 0.3;
cv::Rodrigues(w_,R_);
std::cout<<"R_"<<std::endl;
std::cout<<R_<<std::endl;
std::cout<<R_.at<float>(0,0)<<std::endl;
Это работает просто отлично.
Это минимальное (не) -работающий пример:
#include <opencv2/calib3d.hpp>
#include <opencv2/opencv.hpp>
#include <vector>
int main()
{
cv::Mat w = cv::Mat(3,1,CV_32FC1);
cv::Mat t = cv::Mat(3,1, CV_32FC1);
std::vector<cv::Point3f> tmp1;
std::vector<cv::Point2f> tmp2;
for (int k = 0; k < 10; ++k)
{
cv::Point3f p1(0.2f+k, 0.3f-k, 7.5f-k);
cv::Point2f p2(3.2f*k, 4.5f/k);
tmp1.push_back(p1);
tmp2.push_back(p2);
}
cv::Mat K = cv::Mat::zeros(3,3,CV_32FC1);
K.at<float>(0,0) = 525.0;
K.at<float>(0,2) = 234.5;
K.at<float>(1,1) = 525;
K.at<float>(1,2) = 312.5;
K.at<float>(2,2) = 1.0f;
std::vector<float> distortion = {0,0,0,0};
cv::solvePnPRansac(tmp1, tmp2, K,distortion, w, t,false, 100, 2.0f);
std::cout<<w<<std::endl;
cv::Mat R = cv::Mat::zeros(3,3,CV_32FC1);
cv::Rodrigues(w,R);
std::cout<<R<<std::endl;
std::cout<<R.at<float>(0,0)<<std::endl;
return 0;
}
Скомпилировано с
g++ main.cpp -I /usr/local/include/opencv4/ -o test -L /usr/local/lib/ -lopencv_calib3d -lopencv_core