diff --git a/gtsam/base/Manifold.h b/gtsam/base/Manifold.h index 4fe6c9d99..27fb0f603 100644 --- a/gtsam/base/Manifold.h +++ b/gtsam/base/Manifold.h @@ -140,6 +140,18 @@ struct zero > : public boost::integral_cons } }; +// These functions should maybe be wrapped into a struct object? +template +bool equals(const Eigen::DenseBase& A, const Eigen::DenseBase& B, + double tol) { + return equal_with_abs_tol(A, B, tol); +} + +template +void print(const Eigen::DenseBase& A, const std::string& str) { + print(A,str); +} + template struct is_chart : public boost::false_type {}; } // \ namespace traits