A general and flexible factor graph non-linear least square optimization framework - View it on GitHub