非线性优化
首先说啥非线性优化在SLAM中的一些历史,大家都知道我们都用BA来做非线性优化,但只是优化相邻两张图片间的位姿和路标点.而现在,对于后端优化来说,我们需要优化整个地图的全部位姿和全部路标点,...图优化
所谓的图优化,就是把一个常规的优化问题,以图(Graph)的形式来表述.
图是由顶点(Vertex)和边(Edge)组成的结构.
在SLAM里,图优化一般分解为两个任务:
构建图....位姿图优化
对于路标的优化,可能进行几次之后就已经收敛了,这时候每次插入一个帧都再次进行一次BA仿佛有点用力过猛....换言之:在前端的匹配中,基本都是世界坐标系的点有了,然后根据图像坐标系下的点,估计世界坐标系与图像坐标系下的变换关系作为位姿(这里的世界坐标系下的坐标实际是根据第一帧一路递推下来的,可能错误会一路累积)...以ORB-SLAM中的位姿图优化为例: 首先位姿图优化发生在回环的时候.这个时候,受到回环影响的关键帧就两个位姿:一个是回环前带有漂移的位姿, 一个是回环后将这个漂移消去的位姿.