Consistent sparsification for graph optimization
G2o: A general framework for graph optimization