g2o: A General Framework for Graph Optimization