Feature/initial commit of g2o wrapper

Catkinized. :)

You should be able to use the ```@``` inside the commands to delay the parsing through cmake. see the cmake/g2o-extras.cmake.in for an example