This code shown the use of Bundle Adjustment to construct the 3D map of the environment as well as calculate the camera poses from each frame. - View it on GitHub