gtsam/cpp/Point2Prior.h