gtsam 4.0.2 gtsam Frank Dellaert BSD cmake boost eigen tbb cmake