Revert "Remove gtsam from thirdparty modules."
Merge pull request #39 from ethz-asl/revert-38-feature/remove_gtsam

Revert "Remove gtsam from thirdparty modules."