[feat] Add gtsam

• gtsam is optional

• gtsam master version is used

• Eigen needs to export new variable that is searched by gtsam

• New boost modules are needed (serialization + timer)

• Fix g2o build

• Fix Enable_all option to comply with description