根据单应矩阵H，实现2d点--＞3d点的映射（C++ OpenCV）

最新推荐文章于 2024-05-13 09:55:25 发布

A可乐A

最新推荐文章于 2024-05-13 09:55:25 发布

阅读量146

点赞数

文章标签：矩阵 c++ opencv

本文链接：https://blog.csdn.net/one_cup_of_pepsi/article/details/132288087

版权

Eigen::Vector3d homographyMap(const std::vector<cv::Point3f>& vpts_3f, const std::vector<cv::Point2f>& vpts_2f, const cv::Point2f& Puv)
{
    cv::Mat mask;
    cv::Mat H_64 = cv::findHomography(vpts_3f, vpts_2f, mask);

    cv::Mat H_32 = cv::Mat(3, 3, CV_32F);
    H_64.convertTo(H_32, CV_32F);

    // 2d-ferture
    cv::Mat dst(3, 1, CV_32F);
    dst.at<float>(0, 0) = Puv.x;
    dst.at<float>(1, 0) = Puv.y;
    dst.at<float>(2, 0) = 1.;

    // 3d-feature
    cv::Mat src = H_32.inv() * dst;
    src /= src.at<float>(2, 0);
    src.at<float>(2, 0) = 0.;

    return Eigen::Vector3d(src.at<float>(0, 0), src.at<float>(1, 0), src.at<float>(2, 0));

}