Feature/initial commit of g2o wrapper

Catkinized. :)

What was the reason for the default install command not working properly?