24 using namespace gtsam;
27 #define TEST(TITLE,STATEMENT) \ 29 for(int i = 0; i < n; i++) \ 36 cout <<
"NOTE: Times are reported for " << n <<
" calls" << endl;
38 double norm=
sqrt(1.0+16.0+4.0);
39 double x=1.0/norm,
y=4.0/norm,
z=2.0/norm;
T between(const T &t1, const T &t2)
EIGEN_DEVICE_FUNC const SqrtReturnType sqrt() const
Pose2_ Expmap(const Vector3_ &xi)
Pose2 T2(M_PI/2.0, Point2(0.0, 2.0))
#define TEST(TITLE, STATEMENT)
Class retract(const TangentVector &v) const
retract as required by manifold concept: applies v at *this
Class between(const Class &g) const
set noclip points set clip one set noclip two set bar set border lt lw set xdata set ydata set zdata set x2data set y2data set boxwidth set dummy x
Eigen::Matrix< double, Eigen::Dynamic, 1 > Vector
TangentVector localCoordinates(const Class &g) const
localCoordinates as required by manifold concept: finds tangent vector between *this and g ...