Feature/initial commit of g2o wrapper

Catkinized. :)

can we glob these?