Initial commit.
Merge branch 'master' into feature/initial_commit
So many fixes.
Review comments.
Merge pull request #1 from ethz-asl/feature/initial_commit

Feature/initial commit of g2o wrapper