Factor descent optimization for sparsification in graph SLAM
G2o: A general framework for graph optimization