Implementation of Pose Graph Optimization for Integrated Navigation(GNSS/INS) using GTSAM - View it on GitHub