diff --git a/cpp/TupleConfig-inl.h b/cpp/TupleConfig-inl.h index 785f7cb30..b4f75ef6f 100644 --- a/cpp/TupleConfig-inl.h +++ b/cpp/TupleConfig-inl.h @@ -16,7 +16,7 @@ /*INSTANTIATE_LIE_CONFIG(J2,X2);*/ \ template class PairConfig; \ /*template void PairConfig::print(const std::string&) const;*/ \ - template PairConfig expmap(PairConfig, const VectorConfig&); + template PairConfig expmap(const PairConfig&, const VectorConfig&); // TupleConfig instantiations for N = 1-6 #define INSTANTIATE_TUPLE_CONFIG2(Config1, Config2) \ diff --git a/cpp/TupleConfig.h b/cpp/TupleConfig.h index 9add51d45..a870e1d3a 100644 --- a/cpp/TupleConfig.h +++ b/cpp/TupleConfig.h @@ -177,23 +177,13 @@ namespace gtsam { /** Exmap static functions */ template - inline TupleConfig expmap(const TupleConfig c, const VectorConfig& delta) { - return c.expmap(delta); - } - - template - inline TupleConfigEnd expmap(const TupleConfigEnd c, const VectorConfig& delta) { + inline TupleConfig expmap(const TupleConfig& c, const VectorConfig& delta) { return c.expmap(delta); } /** logmap static functions */ template - inline VectorConfig logmap(const TupleConfig c0, const TupleConfig& cp) { - return c0.logmap(cp); - } - - template - inline VectorConfig logmap(const TupleConfigEnd c0, const TupleConfigEnd& cp) { + inline VectorConfig logmap(const TupleConfig& c0, const TupleConfig& cp) { return c0.logmap(cp); } @@ -225,7 +215,7 @@ namespace gtsam { }; template - TupleConfig2 expmap(const TupleConfig2 c, const VectorConfig& delta) { + TupleConfig2 expmap(const TupleConfig2& c, const VectorConfig& delta) { return c.expmap(delta); } @@ -249,7 +239,7 @@ namespace gtsam { }; template - TupleConfig3 expmap(const TupleConfig3 c, const VectorConfig& delta) { + TupleConfig3 expmap(const TupleConfig3& c, const VectorConfig& delta) { return c.expmap(delta); } @@ -278,7 +268,7 @@ namespace gtsam { }; template - TupleConfig4 expmap(const TupleConfig4 c, const VectorConfig& delta) { + TupleConfig4 expmap(const TupleConfig4& c, const VectorConfig& delta) { return c.expmap(delta); } @@ -307,7 +297,7 @@ namespace gtsam { }; template - TupleConfig5 expmap(const TupleConfig5 c, const VectorConfig& delta) { + TupleConfig5 expmap(const TupleConfig5& c, const VectorConfig& delta) { return c.expmap(delta); } @@ -337,7 +327,7 @@ namespace gtsam { }; template - TupleConfig6 expmap(const TupleConfig6 c, const VectorConfig& delta) { + TupleConfig6 expmap(const TupleConfig6& c, const VectorConfig& delta) { return c.expmap(delta); } @@ -487,14 +477,14 @@ namespace gtsam { /** exponential map */ template - inline PairConfig expmap(const PairConfig c, + inline PairConfig expmap(const PairConfig& c, const VectorConfig& delta) { return c.expmap(delta); } /** log, inverse of exponential map */ template - inline VectorConfig logmap(const PairConfig c0, + inline VectorConfig logmap(const PairConfig& c0, const PairConfig& cp) { return c0.logmap(cp); }