ORB-SLAM2 —- Initializer::Normalize函数

1.函数作用

2.归一化的思想

3.归一化的数学基础

4.归一化Initializer::Normalize代码解读

4.1 构造函数

4.2 归一化的代码解读

归一化特征点到同一尺度,作为后续normalize DLT的输入

为什么要归一化? Ah=0 矩阵A是利用8点法求基础矩阵的关键,所以Hartey就认为,利用8点法求基础矩阵不稳定的一个主要原因就是原始的图像像点坐标组成的系数矩阵A不好造成的,而造成A不好的原因是像点的齐次坐标各个分量的数量级相差太大。基于这个原因,Hartey提出一种改进的8点法,在应用8点法求基础矩阵之前,先对像点坐标进行归一化处理,即对原始的图像坐标做同向性变换,这样就可以 减少噪声的干扰,大大的提高8点法的精度。
预先对图像坐标进行归一化有以下好处: 能够提高运算结果的精度利用归一化处理后的图像坐标,对任何尺度缩放和原点的选择是不变的。
归一化步骤预先为图像坐标选择了一个标准的坐标系中,消除了坐标变换对结果的影响。 归一化操作分两步进行, 首先对每幅图像中的坐标进行平移(每幅图像的平移不同)使图像中匹配的点组成的点集的形心(Centroid)移动到原点; 接着对坐标系进行缩放使得各个分量总体上有一样的平均值,各个坐标轴的缩放相同的。如下图所示:

ORB-SLAM2 ---- Initializer::Normalize函数
使用归一化的坐标虽然能够在一定程度上消除噪声、错误匹配带来的影响,但还是不够的。

一阶矩就是随机变量的期望,二阶矩就是随机变量平方的期望;一阶绝对矩定义为变量与均值绝对值的平均。

ORB-SLAM2 ---- Initializer::Normalize函数

4.1 构造函数

 * @param[in] vKeys                               待归一化的特征点
 * @param[in & out] vNormalizedPoints             特征点归一化后的坐标
 * @param[in & out] T                             归一化特征点的变换矩阵
void Initializer::Normalize(const vector &vKeys, vector &vNormalizedPoints, cv::Mat &T)                           //将特征点归一化的矩阵

我们输入参数为待归一化的特征点,输出参数为特征点归一化后的坐标与归一化变换矩阵。

4.2 归一化的代码解读

void Initializer::Normalize(const vector &vKeys, vector &vNormalizedPoints, cv::Mat &T)                           //将特征点归一化的矩阵
{
    // 归一化的是这些点在x方向和在y方向上的一阶绝对矩(随机变量的期望)。

    // Step 1 计算特征点X,Y坐标的均值 meanX, meanY
    float meanX = 0;
    float meanY = 0;

    //获取特征点的数量
    const int N = vKeys.size();

    //设置用来存储归一后特征点的向量大小,和归一化前保持一致
    vNormalizedPoints.resize(N);

    //开始遍历所有的特征点
    for(int i=0; i(0,0) = sX;
    T.at(1,1) = sY;
    T.at(0,2) = -meanX*sX;
    T.at(1,2) = -meanY*sY;
}

我们首先计算输入八点坐标的

ORB-SLAM2 ---- Initializer::Normalize函数值和ORB-SLAM2 ---- Initializer::Normalize函数值的平均值meanX和meanY ,即ORB-SLAM2 ---- Initializer::Normalize函数
计算 每个特征点与ORB-SLAM2 ---- Initializer::Normalize函数值和ORB-SLAM2 ---- Initializer::Normalize函数值的平均值的偏差程度之和meanDevX和meanDevY,即ORB-SLAM2 ---- Initializer::Normalize函数
计算meanDevX和meanDevY的倒数sX和sY,即ORB-SLAM2 ---- Initializer::Normalize函数
用 SX 与 vNormalizedPoints[i].x 相乘为归一化的坐标,ORB-SLAM2 ---- Initializer::Normalize函数
变换矩阵可以表示为如上矩阵,即ORB-SLAM2 ---- Initializer::Normalize函数ORB-SLAM2 ---- Initializer::Normalize函数矩阵为变换矩阵。

Original: https://blog.csdn.net/qq_41694024/article/details/127821115
Author: Courage2022
Title: ORB-SLAM2 —- Initializer::Normalize函数

原创文章受到原创版权保护。转载请注明出处:https://www.johngo689.com/659256/

转载文章受原作者版权保护。转载请注明原作者出处!

(0)

大家都在看

亲爱的 Coder【最近整理,可免费获取】👉 最新必读书单  | 👏 面试题下载  | 🌎 免费的AI知识星球