Feature/initial commit of g2o wrapper

Catkinized. :)

```cp libg2o* ${CATKIN_DEVEL_PREFIX}/lib/``` instead of this small list?