iSAM is an optimization library for sparse nonlinear problems as encountered in simultaneous localization and mapping (SLAM). - View it on GitHub