added skeleton of g2o solver
added g2o based solver
Merge branch 'loop_solver_g2o' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools
replaced toro with g2o