Feature/initial commit of g2o wrapper

Catkinized. :)

Otherwise this is good to merge and you buy beer to mitigate.