diff --git a/gtsam/geometry/StereoCamera.h b/gtsam/geometry/StereoCamera.h index cdd62a675..1998ce79d 100644 --- a/gtsam/geometry/StereoCamera.h +++ b/gtsam/geometry/StereoCamera.h @@ -85,6 +85,11 @@ namespace gtsam { return 6; } + /** Dimensionality of the tangent space */ + static inline size_t Dim() { + return 6; + } + /** Exponential map around p0 */ inline StereoCamera expmap(const Vector& d) const { return StereoCamera(pose().expmap(d), calibration());