ORB-SLAM2源码学习:Tracking.cc(11):Tracking::SearchLocalPoints()用局部地图点进行投影匹配

前言

简单总结一下:就是用于投影的是排除掉当前帧的地图点并且能被当前帧看到的局部地图点。

这一部分用于投影的地图点是局部地图点中不属于当前帧的地图点,且这些地图点要在当前帧的视野范围内。

1.函数声明

void Tracking::SearchLocalPoints()

2.函数定义

具体的流程如下:

1.遍历当前帧的地图点,将这些地图点从局部地图点中进行去除。

for(vector<MapPoint*>::iterator vit=mCurrentFrame.mvpMapPoints.begin(), vend=mCurrentFrame.mvpMapPoints.end(); vit!=vend; vit++)
    {
        MapPoint* pMP = *vit;
        if(pMP)
        {
            if(pMP->isBad())
            {
                *vit = static_cast<MapPoint*>(NULL);
            }
            else
            {
                // 更新能观测到该点的帧数加1(被当前帧观测了)
                pMP->IncreaseVisible();
                // 标记该点被当前帧观测到
                pMP->mnLastFrameSeen = mCurrentFrame.mnId;
                // 标记该点在后面搜索匹配时不被投影,因为已经有匹配了
                pMP->mbTrackInView = false;
            }
        }

2.判断当前局部地图点中除去当前帧的

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值