ORB_SLAM2 frame.cc 中实现去畸变函数（UnditortPoints）

最新推荐文章于 2025-04-30 13:53:38 发布

戳我啊你

最新推荐文章于 2025-04-30 13:53:38 发布

阅读量582

点赞数

CC 4.0 BY-SA版权

分类专栏： slam 文章标签： slam opencv 计算机视觉

本文链接：https://blog.csdn.net/ryankaros/article/details/115570694

slam 专栏收录该内容

12 篇文章

订阅专栏

本文介绍了一个用于图像处理的去畸变函数UndistortKeyPoints的实现细节，该函数使用OpenCV库对图像特征点进行畸变校正，适用于稀疏点集。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

frame.cc 中实现去畸变函数（UnditortPoints）

在这里插入图片描述此函数常作用于稀疏点集的去畸变
src: 输入的图像点坐标 2xN/Nx2 1-channel or 1xN/Nx1 2-channel (CV_32FC2 or CV_64FC2) (or vector )
dst：输出的去畸变之后的坐标 1xN/Nx1 2-channel or vector
cameraMatrix: 相机内参矩阵
distCoeffs：相机畸变系数

void Frame::UndistortKeyPoints()
{
    // 如果没有图像是矫正过的，没有失真
    if(mDistCoef.at<float>(0)==0.0)
    {
        mvKeysUn=mvKeys;
        return;
    }

    // Fill matrix with points
    // N为提取的特征点数量，将N个特征点保存在N*2的mat中
    cv::Mat mat(N,2,CV_32F);
    for(int i=0; i<N; i++)
    {
        mat.at<float>(i,0)=mvKeys[i].pt.x;
        mat.at<float>(i,1)=mvKeys[i].pt.y;
    }

    // Undistort points
    // 调整mat的通道为2，矩阵的行列形状不变
    mat=mat.reshape(2);
    cv::undistortPoints(mat,mat,mK,mDistCoef,cv::Mat(),mK); // 用cv的函数进行失真校正
    mat=mat.reshape(1);

    // Fill undistorted keypoint vector
    // 存储校正后的特征点
    mvKeysUn.resize(N);
    for(int i=0; i<N; i++)
    {
        cv::KeyPoint kp = mvKeys[i];
        kp.pt.x=mat.at<float>(i,0);
        kp.pt.y=mat.at<float>(i,1);
        mvKeysUn[i]=kp;
    }
}