diff --git a/gtsam/geometry/Unit3.h b/gtsam/geometry/Unit3.h index b7d359f40..428211c6b 100644 --- a/gtsam/geometry/Unit3.h +++ b/gtsam/geometry/Unit3.h @@ -87,6 +87,17 @@ public: p_.normalize(); } + /// Copy constructor + Unit3(const Unit3& u) { + p_ = u.p_; + } + + /// Copy assignment + Unit3& operator=(const Unit3 & u) { + p_ = u.p_; + return *this; + } + /// Named constructor from Point3 with optional Jacobian static Unit3 FromPoint3(const Point3& point, // OptionalJacobian<2, 3> H = boost::none);