This is a coding practice of bundle adjustment for visual slam, i.e., an Levenberg-Marquardt optimizer with only the usage of Eigen and Sophus. When solving the equation, the operations are manipulated by block-matrix. Some code snippets are learned from the following reference:
whigg / vslam Goto Github PK
View Code? Open in Web Editor NEWThis project forked from randysuen/vslam
bundle adjustment for visual slam