diff --git a/gtsam/slam/BetweenFactor.h b/gtsam/slam/BetweenFactor.h index 0b20c1286..09e1d310a 100644 --- a/gtsam/slam/BetweenFactor.h +++ b/gtsam/slam/BetweenFactor.h @@ -31,6 +31,10 @@ namespace gtsam { template class BetweenFactor: public NoiseModelFactor2 { + // Check that VALUE type is a testable Lie group + BOOST_CONCEPT_ASSERT((IsTestable)); + BOOST_CONCEPT_ASSERT((IsLieGroup)); + public: typedef VALUE T; @@ -42,11 +46,6 @@ namespace gtsam { VALUE measured_; /** The measurement */ - /** concept check by type */ - // TODO(ASL) Reenable - //GTSAM_CONCEPT_LIE_TYPE(T) - //GTSAM_CONCEPT_TESTABLE_TYPE(T) - public: // shorthand for a smart pointer to a factor