Feature/initial commit of g2o wrapper

Catkinized. :)

cmake is masking the command so that the wildcard is no working properly :(