Feature/initial commit of g2o wrapper

Catkinized. :)

I think it is better to take a certain release-tag or commit to make sure everyone is using the same version and we can control the updates.