diff --git a/gtsam/geometry/Rot3Q.cpp b/gtsam/geometry/Rot3Q.cpp index 72d50484b..8e0f46e92 100644 --- a/gtsam/geometry/Rot3Q.cpp +++ b/gtsam/geometry/Rot3Q.cpp @@ -62,6 +62,11 @@ namespace gtsam { /* ************************************************************************* */ Rot3::Rot3(const Quaternion& q) : quaternion_(q) {} + /* ************************************************************************* */ + void Rot3::print(const std::string& s) const { + gtsam::print((Matrix)matrix(), s); + } + /* ************************************************************************* */ Rot3 Rot3::Rx(double t) { return Quaternion(Eigen::AngleAxisd(t, Eigen::Vector3d::UnitX())); }