fgs_opt Mathematical optimization packages. Following optimizers are used. Ceres-Solver http://ceres-solver.org/ General Graph Optimization https://github.com/RainerKuemmerle/g2o From scratch Trying to implement optimization algorithm myself...