gtsam/cpp/Pose3Factor.h