fix/gtsam_eigen
updated some submodules
Add gtsam
Merge branch 'feature/add_gtsam' into fix/gtsam_eigen
Merge pull request #31 from ethz-asl/fix/gtsam_eigen

Fix/gtsam eigen