iSAM is an optimization library for sparse nonlinear problems as encountered in simultaneous localization and mapping (SLAM) in mobile robotics. The iSAM library provides efficient algorithms for batch and incremental optimization, recovering the exact least-squares solution. The library can easily be extended to new problems, and functionality for often encountered 2D and 3D SLAM problems is already provided.
Libpointmatcher is a modular "Iterative Closest Point" library, useful for robotics and computer vision. This library is designed with modularity and performance in mind. It provides building blocks to construct various ICP chains often seen in research. These chains can be tuned without any recompilation, and new modules can be added without modifying the core of the library.