graph-based optimization INS/GNSS positioning - View it on GitHub