diff --git a/gtsam/slam/expressions.h b/gtsam/slam/expressions.h index f2967a88b..5a65810aa 100644 --- a/gtsam/slam/expressions.h +++ b/gtsam/slam/expressions.h @@ -199,4 +199,14 @@ gtsam::Expression::TangentVector> logmap( gtsam::traits::Logmap, between(x1, x2)); } +template +inline Expression interpolate(const Expression& p, const Expression& q, + const Expression& t){ + T (*f)(const T&, const T&, double, + typename MakeOptionalJacobian::type, + typename MakeOptionalJacobian::type, + typename MakeOptionalJacobian::type) = &interpolate; + return Expression(f, p, q, t); +} + } // \namespace gtsam