Feature/initial commit of g2o wrapper

Catkinized. :)

Also you should use the ${CMAKE_SHARED_LIBRARY_SUFFIX} here too, otherwise this will be unhappy on OSX