GTSAM  4.0.2
C++ library for smoothing and mapping (SAM)
Solving by sequential variable elimination (QR and Cholesky)