diff --git a/gtsam/slam/expressions.h b/gtsam/slam/expressions.h index d1bfab7f2..8d34ce681 100644 --- a/gtsam/slam/expressions.h +++ b/gtsam/slam/expressions.h @@ -155,10 +155,10 @@ Point2_ project2(const Expression& camera_, const Expression& p_) namespace internal { // Helper template for project3 expression below template -inline Point2 project6(const Pose3& x, const Point3& p, const Cal3_S2& K, +inline Point2 project6(const Pose3& x, const POINT& p, const CALIBRATION& K, OptionalJacobian<2, 6> Dpose, OptionalJacobian<2, 3> Dpoint, - OptionalJacobian<2, 5> Dcal) { - return PinholeCamera(x, K).project(p, Dpose, Dpoint, Dcal); + OptionalJacobian<2, CALIBRATION::dimension> Dcal) { + return PinholeCamera(x, K).project(p, Dpose, Dpoint, Dcal); } }