GTSAM 因子图平滑与增量位姿估计解析

文章解析 GTSAM 因子图状态估计，介绍位姿图与 IMU 预积分因子的构建方式，并对批量 LM 与 iSAM2 增量求解做对拍实验。文中还分析回环检测触发全局修正的过程，以及贝叶斯树增量推理的数值验证。