diff --git a/gtsam/geometry/BearingRange.h b/gtsam/geometry/BearingRange.h index 38fb47067..a147c60cd 100644 --- a/gtsam/geometry/BearingRange.h +++ b/gtsam/geometry/BearingRange.h @@ -64,6 +64,15 @@ struct BearingRange // return BearingRange(b, r); // } // + void print(const std::string& str = "") const { + traits::Print(this->first, str); + traits::Print(this->second, str); + } + bool equals(const BearingRange& m2, double tol = 1e-8) const { + return traits::Equals(this->first, m2.first, tol) && + traits::Equals(this->second, m2.second, tol); + } + private: /// Serialization function template @@ -77,21 +86,8 @@ struct BearingRange template struct traits > - // : internal::ManifoldTraits > - { - typedef typename Bearing::result_type B; - typedef typename Range::result_type R; - - static void Print(const BearingRange& m, - const std::string& str = "") { - traits::Print(m.first, str); - traits::Print(m.second, str); - } - static bool Equals(const BearingRange& m1, - const BearingRange& m2, double tol = 1e-8) { - return traits::Equals(m1.first, m2.first, tol) && - traits::Equals(m1.second, m2.second, tol); - } -}; + : Testable > + // : internal::ManifoldTraits > + {}; } // namespace gtsam