diff --git a/gtsam_unstable/slam/expressions.h b/gtsam_unstable/slam/expressions.h index 009be46a1..c72a9d3f7 100644 --- a/gtsam_unstable/slam/expressions.h +++ b/gtsam_unstable/slam/expressions.h @@ -20,9 +20,8 @@ typedef Expression Rot2_; typedef Expression Pose2_; Point2_ transform_to(const Pose2_& x, const Point2_& p) { - Point2(Pose2::*transform)(const Point2& p, - boost::optional H1, - boost::optional H2) const = &Pose2::transform_to; + Point2 (Pose2::*transform)(const Point2& p, FixedRef<2, 3> H1, + FixedRef<2, 2> H2) const = &Pose2::transform_to; return Point2_(x, transform, p); } @@ -35,9 +34,8 @@ typedef Expression Pose3_; Point3_ transform_to(const Pose3_& x, const Point3_& p) { - Point3(Pose3::*transform)(const Point3& p, - boost::optional Dpose, - boost::optional Dpoint) const = &Pose3::transform_to; + Point3 (Pose3::*transform)(const Point3& p, FixedRef<3, 6> Dpose, + FixedRef<3, 3> Dpoint) const = &Pose3::transform_to; return Point3_(x, transform, p); } @@ -51,8 +49,7 @@ Point2_ project(const Point3_& p_cam) { } Point2 project6(const Pose3& x, const Point3& p, const Cal3_S2& K, - boost::optional Dpose, boost::optional Dpoint, - boost::optional Dcal) { + FixedRef<2, 6> Dpose, FixedRef<2, 3> Dpoint, FixedRef<2, 5> Dcal) { return PinholeCamera(x, K).project(p, Dpose, Dpoint, Dcal); }