add pose_graph_optimizer