Computer Vision, GTSAM