generic-library/opencv
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Return the estimated focal length

Browse Source
This commit is contained in:
edgarriba
2014-10-02 17:05:42 +02:00
parent ea893bf9d9
commit 7520544840
3 changed files with 6 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
modules/calib3d/src/upnp.cpp
View File

@@ -53,7 +53,7 @@ upnp::~upnp()
delete[] A2;
}
void upnp::compute_pose(cv::Mat& R, cv::Mat& t)
double upnp::compute_pose(cv::Mat& R, cv::Mat& t)
{
choose_control_points();
compute_alphas();
@@ -72,7 +72,6 @@ void upnp::compute_pose(cv::Mat& R, cv::Mat& t)
cvMulTransposed(M, &MtM, 1);
cvSVD(&MtM, &D, &Ut, 0, CV_SVD_MODIFY_A | CV_SVD_U_T);
//check_positive_eigenvectors(ut); // same result
cvReleaseMat(&M);
double l_6x12[6 * 12], rho[6];
@@ -99,6 +98,8 @@ void upnp::compute_pose(cv::Mat& R, cv::Mat& t)
cv::Mat(3, 1, CV_64F, ts[N]).copyTo(t);
cv::Mat(3, 3, CV_64F, Rs[N]).copyTo(R);
return Efs[N][0];
}
void upnp::copy_R_and_t(const double R_src[3][3], const double t_src[3],
@@ -186,14 +187,6 @@ void upnp::solve_for_sign(void)
}
}
void upnp::check_positive_eigenvectors(double * ut)
{
for (int i = 0; i < 12; ++i)
if (ut[12 * i] < 0.0) {
for (int j = 0; j < 12; ++j)ut[12 * i + j] = -ut[12 * i + j];
}
}
double upnp::compute_R_and_t(const double * ut, const double * betas, const double * efs,
double R[3][3], double t[3])
{