A robust sensor fusion library for online localization
...The general idea of factor graphs is to describe the state estimation problem as a graph of nodes (the state variables) that are connected by factors (measurements). The resulting graph optimization problem can be solved by applying non-linear least squares optimization.