因子图优化+贝叶斯滤波 A fork of Georgia Tech Smoothing and Mapping library - View it on GitHub