diff --git a/gtsam_unstable/dynamics/PoseRTV.h b/gtsam_unstable/dynamics/PoseRTV.h index a6bc6006a..bef397cb6 100644 --- a/gtsam_unstable/dynamics/PoseRTV.h +++ b/gtsam_unstable/dynamics/PoseRTV.h @@ -173,14 +173,7 @@ struct traits : public internal::LieGroup {}; // Define Range functor specializations that are used in RangeFactor template struct Range; -template <> -struct Range { - typedef double result_type; - double operator()(const PoseRTV& pose1, const PoseRTV& pose2, - OptionalJacobian<1, 9> H1 = boost::none, - OptionalJacobian<1, 9> H2 = boost::none) { - return pose1.range(pose2, H1, H2); - } -}; +template<> +struct Range : HasRange {}; } // \namespace gtsam