GTSAM from Prof. Frank Dellaert - View it on GitHub