dso后端

3.2 FullSystem::makeNonKeyFrame

非关键帧处理,更新窗口中关键帧immaturePoints的逆深度

3.2.1 traceNewCoarse(fh)

遍历所有活动帧(关键帧frameHessians!!!)中,对于主导帧中的未成熟点,在极线上追踪这些未成熟点(调用ImmaturePoint::traceOn)

3.2.1.1 ImmaturePoint::traceOn

先进行极线搜索,搜索到一个较好的位置,然后使用高斯牛顿优化,最后更新idepth_min\idepth_max,ImmaturePoint没有确切的idepth

1、确定极线范围
 将未成熟的点根据相对位姿和之前的逆深度范围idepth_min、idepth_max投影到当前帧上得到[uMin, vMin], [uMax, vMax],确定极线方向,搜索步长step

2、离散搜索

按照8点进行搜索,找到光度误差最小的点,作为一个比较好的值

3、最小误差优化对步长进行高斯牛顿优化

进行高斯牛顿优化,在最小误差位置,优化变量为步长,然后对投影位置进行更新

4、更新idepth_min\idepth_max

3.3、FullSystem::makeKeyFrame
关键帧处理,包括如下步骤:

1、同非关键帧一样对前面关键帧的未成熟点对逆深度的范围进行更新FullSystem::traceNewCoarse

2、标记后面需要边缘化的帧,边缘化决策FullSystem::flagFramesForMarginalization

3、将当前帧加入到滑动窗口(active frames)中,并计算该窗口中其它帧与当前帧的一些参数,相对光度、距离setPrecalcValues()

4、对于窗口旧帧中成熟点,可以在除了主导帧之外的任意一帧进行投影,形成一残差项,记录在PointHessian::residuals中

5、激活窗口中之前所有符合条件的未成熟点,选出待激活点,进行高斯牛顿优化并激活activatePointsMT()

6、利用高斯牛顿法对滑动窗口中所有变量进行优化optimize

7、去除外点removeOutliers

8、边缘化点;先标志边缘化的点flagPointsForRemoval(),再边缘化不需要的点,变为先验信息ef->marginalizePointsF

9、在新关键帧中提取未成熟点makeNewTraces

10、边缘化不需要的帧marginalizeFrame

3.3.1、FullSystem::flagFramesForMarginalization

边缘化策略1:成熟点与未成熟点数量比例小于阈值5% 或者 和当前帧的相对光度光度较大;

边缘化策略2:如果通过前面的策略,数量仍超阈值,则从全部帧中找出除最近两帧外(年龄)离当前帧最远的一帧(距离)

3.3.2、FullSystem::activatePointsMT

遍历最新关键帧除外的活跃帧,遍历帧中的未成熟点,激活条件为极线长度<8,次最小误差比最小误差>3;

将逆深度设为最大最小的平均,投影到当前帧,考虑重投影点在距离图上的值,若该值足够大,可认为该点附近没有成熟点,将其加入待优化序列toOptimize;

对待优化未成熟点优化(逆深度)并激活为成熟点activatePointsMT_Reductor(转到FullSystem::optimizeImmaturePoint:)

 

上一篇:Hbase


下一篇:树分治TLE原因