ORB-SLAM2源码学习:LocalMapping.cc: LocalMapping::MapPointCulling剔除不合格的地图点

前言

新增地图点需要经过比较严苛的筛选才能留下,只有这样才能提高定位和建图的准确性、控制地图建图规模、降低计算量。

新增地图点主要来自a.双目相机和RGB-D相机模式下的跟踪线程产生的地图点b.局部建图线程中关键帧之间生成的新的地图点。

函数声明

cpp 复制代码
void LocalMapping::MapPointCulling()

函数定义

地图点(即关键帧中生成的 3D 点)的删除条件

满足以下任意一个条件的地图点会被删除:

条件一:地图点的观测相机数量相对于预测相机数量的比例小于 25%。

解释:每个地图点在被创建时都有一个预计的观测相机数量,这些观测相机可以看到或检测到这个地图点。当实际观测到该地图点的相机数量小于预测数量的 25% 时,该地图点将被删除。这一条件的设立目的是删除那些在实际观测中少于预期的地图点,减少冗余数据。

条件二:从地图点建立开始,已经超过了 2 个关键帧,且该地图点的观测相机数未超过阈值 cnThObs。

cnThObs 的具体定义:对于单目相机,cnThObs = 2。对于双目或 RGB-D 相机,cnThObs = 3。

相机观测计数方法:每观测一次,观测相机数加 1。如果用双目或 RGB-D 相机观测一次,则相机数加 2。

解释:此条件设立是为了清除那些在创建后无法被足够多的相机观测到的地图点。当一个地图点建立后,如果经过了 2 个关键帧的时间周期,且观测到该点的相机数量仍不足,则说明该点的观测数据较少,可能并不是一个稳定的、可靠的地图点,因此会将其删除。这一操作有助于保持地图点的准确性和有效性。

cpp 复制代码
void LocalMapping::MapPointCulling()
{
    // Check Recent Added MapPoints
    list<MapPoint*>::iterator lit = mlpRecentAddedMapPoints.begin();
    const unsigned long int nCurrentKFid = mpCurrentKeyFrame->mnId;

    // Step 1:根据相机类型设置不同的观测阈值
    int nThObs;
    if(mbMonocular)
        nThObs = 2;
    else
        nThObs = 3;
    const int cnThObs = nThObs;
	
	// Step 2:遍历检查新添加的地图点
    while(lit!=mlpRecentAddedMapPoints.end())
    {
        MapPoint* pMP = *lit;
        if(pMP->isBad())
        {
            // Step 2.1:已经是坏点的地图点仅从队列中删除
            lit = mlpRecentAddedMapPoints.erase(lit);
        }
        else if(pMP->GetFoundRatio()<0.25f)
        {
            // Step 2.2:跟踪到该地图点的帧数相比预计可观测到该地图点的帧数的比例小于25%,从地图中删除
            // (mnFound/mnVisible) < 25%
            // mnFound :地图点被多少帧(包括普通帧)看到,次数越多越好
            // mnVisible:地图点应该被看到的次数
            // (mnFound/mnVisible):对于大FOV镜头这个比例会高,对于窄FOV镜头这个比例会低
            pMP->SetBadFlag();
            lit = mlpRecentAddedMapPoints.erase(lit);
        }
        else if(((int)nCurrentKFid-(int)pMP->mnFirstKFid)>=2 && pMP->Observations()<=cnThObs)
        {
            // Step 2.3:从该点建立开始,到现在已经过了不小于2个关键帧
            // 但是观测到该点的相机数却不超过阈值cnThObs,从地图中删除
            pMP->SetBadFlag();
            lit = mlpRecentAddedMapPoints.erase(lit);
        }
        else if(((int)nCurrentKFid-(int)pMP->mnFirstKFid)>=3)
            // Step 2.4:从建立该点开始,已经过了3个关键帧而没有被剔除,则认为是质量高的点
            // 因此没有SetBadFlag(),仅从队列中删除
            lit = mlpRecentAddedMapPoints.erase(lit);
        else
            lit++;
    }
}

结束语

以上就是我学习到的内容,如果对您有帮助请多多支持我,如果哪里有问题欢迎大家在评论区积极讨论,我看到会及时回复。

相关推荐
ShineWinsu14 分钟前
对于Qt:QGripLayout常见属性、方法以及QSizePolicy的解析
开发语言·c++·qt·面试·gui·客户端·网格
艾莉丝努力练剑27 分钟前
【AI大模型接入SDK】C++的SessionManager 线程安全
java·开发语言·前端·c++·人工智能·学习·安全
辰小忆1 小时前
11 · RunCurveChart —— 实时运行曲线
c++·ui·duilib
蒸蒸yyyyzwd1 小时前
数据库相关错题笔记
笔记·学习
利威尔xu1 小时前
Go Mutex 饥饿模式:正常模式等待者饿死,1ms 阈值自动切换崩溃
开发语言·后端·面试·golang·并发编程
乌暮2 小时前
少写重复 CRUD:用大白话搞懂 MyBatis-Plus
java·开发语言·spring boot·面试·mybatis
不绝1913 小时前
Lua基础语法入门:注释、变量类型与字符串操作
开发语言·lua
蒸蒸yyyyzwd3 小时前
后端学习笔记,设计模式相关以及微服务相关
笔记·学习
Hhy_11073 小时前
《C++深度解构07》手撕 vector —— 从底层三指针架构到迭代器失效彻底吃透
c语言·开发语言·c++·学习·visual studio
风落青芜3 小时前
链式二叉树的实现与基本操作
c语言·开发语言·数据结构·算法