Pose Graph Optimization

Pose Graph Optimization for 1D and 2D SLAM using Gauss Newton and Levenberg-Marquardt algorithms.