Fusion of gps and slam info by isam2. - View it on GitHub