Adding g2o and pose_graph_slam.