g2o的安装及初步使用

g2o的安装及初步使用 
运行环境：ubuntu12.04 + g2o 
个人原创，转载请注明来自Jasmine_shine的专栏：

一、g2o的安装 
1、安装依赖项： 
sudo apt-get install libeigen3-dev libsuitesparse-dev libqt4-dev qt4-qmake libqglviewer-qt4-dev 
2、从官网上下载并从源码安装，下载网址为。 
将此文件解压，可以采用命令，也可以直接右键“提取到此处“，然后放到你想放的文件路径里。源码安装：

mkdir build cd build
cmake ..
make sudo make install

	
	

		1
	

	

		2
	

	

		3
	

	

		4
	

	

		5
	

如果编译没有出错，就会在/usr/local/include看到g2o的包含文件，在usr/local/lib看到g2o的库文件，在usr/local/bin看到g2o的可执行文件。

具体的安装方式可参考博客：http://www.cnblogs.com/gaoxiang12/p/4739934.html

二、g2o的小试牛刀 
g2o是一些大牛们封装好的一个可以计算图优化的一个库，因此只需要输入一组点和边的信息，g2o就可以进一步优化你的这些点和边。下面是一个优化圆的例子。 
在Ubuntu环境下，要先创建一个文件夹，代表一个工程。这个工程必须包含几个子文件夹，分别是bin（生成的可执行文件的存放路径），include(包含的头文件，也就是.h文件)，data(提取的实验数据), src(源文件，也就是.cpp文件), CMakeLists.txt（编译环境设置）。 
此时的CMakeList.txt与源文件中的不同，只需设置一些简单的编译条件即可：

CMAKE_MINIMUM_REQUIRED( VERSION 2.8 ) PROJECT( g2o_test ) SET(CMAKE_CXX_COMPILER "g++") SET( CMAKE_BUILD_TYPE Debug  ) SET(EXECUTABLE_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/bin) SET(LIBRARY_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/lib) INCLUDE_DIRECTORIES( ${PROJECT_SOURCE_DIR}/include ) LINK_DIRECTORIES( ${PROJECT_SOURCE_DIR}/lib) ADD_SUBDIRECTORY( ${PROJECT_SOURCE_DIR}/src ) 

	
	

		1
	

	

		2
	

	

		3
	

	

		4
	

	

		5
	

	

		6
	

	

		7
	

	

		8
	

	

		9
	

	

		10
	

	

		11
	

	

		12
	

	

		13
	

	

		14
	

在这里，我们值涉及到一个简单的main.cpp文件，如下：

#include "g2o/core/sparse_optimizer.h" #include "g2o/core/block_solver.h" #include "g2o/core/factory.h" #include "g2o/core/optimization_algorithm_levenberg.h" #include "g2o/solvers/csparse/linear_solver_csparse.h" #include "g2o/types/slam3d/vertex_se3.h" //#include "g2o/types/slam3d/edge_se3.h" // 使用 宏函数 声明边和顶点类型，注意注释掉了上面两个头文件  G2O_USE_TYPE_GROUP(slam3d); //G2O_USE_TYPE_GROUP(slam2d); //2d平面 #include  using namespace std; using namespace g2o; #define MAXITERATION 50 int main()
{ cout<< "Hello g2o"<// create the linear solver BlockSolverX::LinearSolverType * linearSolver = new LinearSolverCSparse(); // create the block solver on the top of the linear solver BlockSolverX* blockSolver = new BlockSolverX(linearSolver); //create the algorithm to carry out the optimization OptimizationAlgorithmLevenberg* optimizationAlgorithm = new OptimizationAlgorithmLevenberg(blockSolver); /*  //如果没用前面的宏函数，而是调用的是edge_se3和vertex_se3头文件
    //想让程序能识别VertexSE3这些数据类型，就要显示的调用它们，如下
    //如果只用了头文件，而没用显示调用，那么这些数据类型将不会link进来
    //在下面的optimizer.load函数将不能识别这些数据类型
    for(int f=0; f<10;++f)
    {
        VertexSE3* v = new VertexSE3;
        v->setId(f++);
    }
*/ // create the optimizer SparseOptimizer optimizer; if(!optimizer.load("../data/sphere_bignoise_vertex3.g2o"))
    { cout<<"Error loading graph"<return -1;
    }else { cout<<"Loaded "<" vertices"<cout<<"Loaded "<" edges"<//优化过程中，第一个点固定，不做优化; 也可以不固定。 VertexSE3* firstRobotPose = dynamic_cast(optimizer.vertex(0));
    firstRobotPose->setFixed(true);

    optimizer.setAlgorithm(optimizationAlgorithm);
    optimizer.setVerbose(true);
    optimizer.initializeOptimization(); cerr<<"Optimizing ..."<cerr<<"done."<"../data/sphere_after.g2o"); //optimizer.clear(); return 0;
}

	
	

		1
	

	

		2
	

	

		3
	

	

		4
	

	

		5
	

	

		6
	

	

		7
	

	

		8
	

	

		9
	

	

		10
	

	

		11
	

	

		12
	

	

		13
	

	

		14
	

	

		15
	

	

		16
	

	

		17
	

	

		18
	

	

		19
	

	

		20
	

	

		21
	

	

		22
	

	

		23
	

	

		24
	

	

		25
	

	

		26
	

	

		27
	

	

		28
	

	

		29
	

	

		30
	

	

		31
	

	

		32
	

	

		33
	

	

		34
	

	

		35
	

	

		36
	

	

		37
	

	

		38
	

	

		39
	

	

		40
	

	

		41
	

	

		42
	

	

		43
	

	

		44
	

	

		45
	

	

		46
	

	

		47
	

	

		48
	

	

		49
	

	

		50
	

	

		51
	

	

		52
	

	

		53
	

	

		54
	

	

		55
	

	

		56
	

	

		57
	

	

		58
	

	

		59
	

	

		60
	

	

		61
	

	

		62
	

	

		63
	

	

		64
	

	

		65
	

	

		66
	

	

		67
	

	

		68
	

	

		69
	

此外，在src文件夹下必须建一个CMakeList.txt文件，用于编译main.cpp。

 # 添加g2o的依赖 # 因为g2o不是常用库，要添加它的findg2o.cmake文件 LIST( APPEND CMAKE_MODULE_PATH ${PROJECT_SOURCE_DIR}/cmake_modules ) SET( G2O_ROOT /usr/local/include/g2o ) FIND_PACKAGE( G2O ) # CSparse FIND_PACKAGE( CSparse ) INCLUDE_DIRECTORIES( ${G2O_INCLUDE_DIR} ${CSPARSE_INCLUDE_DIR} ) find_package(Eigen3 REQUIRED) find_package(CSparse REQUIRED) #find_package(Cholmod REQUIRED) include_directories(${CSPARSE_INCLUDE_DIR}) include_directories(${EIGEN3_INCLUDE_DIR}) #include_directories(${CHOLMOD_INCLUDE_DIR}) SET(G2O_LIBS g2o_cli g2o_ext_freeglut_minimal g2o_simulator g2o_solver_slam2d_linear g2o_types_icp g2o_types_slam2d g2o_core g2o_interface g2o_solver_csparse g2o_solver_structure_only g2o_types_sba g2o_types_slam3d g2o_csparse_extension g2o_opengl_helper g2o_solver_dense g2o_stuff g2o_types_sclam2d g2o_parser g2o_solver_pcg g2o_types_data g2o_types_sim3 cxsparse ) ADD_EXECUTABLE(g2o_test main.cpp) target_link_libraries(g2o_test ${G2O_LIBS}) #target_link_libraries(g2o_test csparse g2o_core g2o_solver_cholmod g2o_solver_csparse g2o_types_slam3d)

	
	

		1
	

	

		2
	

	

		3
	

	

		4
	

	

		5
	

	

		6
	

	

		7
	

	

		8
	

	

		9
	

	

		10
	

	

		11
	

	

		12
	

	

		13
	

	

		14
	

	

		15
	

	

		16
	

	

		17
	

	

		18
	

	

		19
	

	

		20
	

	

		21
	

	

		22
	

	

		23
	

	

		24
	

	

		25
	

到目前为止，main.cpp以及编译配置都已经完成，数据的输入data提取的是这个网址里的数据：。

一般情况下，编译所需的文件都已经差不多了，但是这个程序依赖很多库，所以需额外在工程文件夹下添加一个cmake_modules文件夹，里面包含很多cmake文件。下载地址为：。

so，你现在可以执行

mkdir build cd build
cmake ..
make 

	
	

		1
	

	

		2
	

	

		3
	

	

		4
	

	

		5
	

到目前为止，如果没有意外的话，应该在bin文件夹下生成了一个跟工程名相同的可执行文件，只需要执行这个文件./g2o_test，就会在data文件夹下生成一个.g2o的文件。采用g2o_viewer 即可看到生成的文件。但是由于个人在安装的时候在/usr/local/bin没有生成g2o_viewer这个可执行文件，所以不能可视化这个文件。

后续的话，可能会更注重g2o的原理了，毕竟操作是最简单的，先从形象话了解一些g2o的使用，对之后的理解可能是好的。

本篇博客在前人的基础上实际操作和总结的，稍有不同，主要是根据个人环境配置和编译的。 
参考博客：白巧克力亦唯心