LSD-SLAM深入学习(3)-代码解析


前言

     在LSD-SLAM深入学习(2)中我们已经对算法进行分析,此处假设读者对于ros的基本操作都已经很熟悉,而且已经编写了一定量的的代码,我们直接上干货。此处分析的程序如下

main_live_odometry.cpp,这个可以实时读取视频的主函数

LSD-SLAM深入学习(3)-代码解析

     个人理解错误的地方还请不吝赐教,转载请标明出处,内容如有改动更新,请看原博:http://www.cnblogs.com/hitcm/

     如有任何问题,feel free to contact me at [email protected]


主函数

XInitThreads();用于多线程显示imshow();

实时数据流参考下面的,利用每一张图片的可以参考main_on_images.cpp

LSD-SLAM深入学习(3)-代码解析

然后划定输入输出,把输入输出传递到一个slam对象中去。

LSD-SLAM深入学习(3)-代码解析

monoodometry初始化中开启了下面的线程,mapping、constraint以及optimization

LSD-SLAM深入学习(3)-代码解析

LSD-SLAM深入学习(3)-代码解析


tracking线程

要开启其他线程,完成tracking的任务。Tracking的主要目的是配准两幅图,得到位姿变化。

相对位姿可以通过最小化方差归一化的光学误差来计算。地图刚开始会随机进行深度信息的初始化,然后才能进行跟踪帧。

LSD-SLAM深入学习(3)-代码解析

跟踪帧的任务如下

LSD-SLAM深入学习(3)-代码解析

这个是se3的tracker,执行trackframe的任务……函数比较大,也很重要,主要求解李群下面的问题。

LSD-SLAM深入学习(3)-代码解析


map线程

LSD-SLAM深入学习(3)-代码解析

具体的doMappingIteration()内容如下

LSD-SLAM深入学习(3)-代码解析

Mapping的很多工作都是在下面的updatekeyframe函数中实现的……

LSD-SLAM深入学习(3)-代码解析

一个很重要的函数是dolinestereo,就是在极线上进行立体匹配。


constrait线程

LSD-SLAM深入学习(3)-代码解析


optimization线程

改变bool变量doFinalOptimization的值是在最后完成的,和其他线程没关系的……也就是采集不到新的图时……

LSD-SLAM深入学习(3)-代码解析