Go to the documentation of this file.
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;
46 TEST(localCoordinates,
T.localCoordinates(
T2))
48 TEST(between_derivatives,
T.between(
T2,H1,H2))
49 TEST(Logmap, Pose3::Logmap(
T.between(
T2)))
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
def retract(a, np.ndarray xi)
Pose2_ Expmap(const Vector3_ &xi)
static const Pose3 T2(Rot3::Rodrigues(0.3, 0.2, 0.1), P2)
Array< int, Dynamic, 1 > v
T between(const T &t1, const T &t2)
Eigen::Matrix< double, Eigen::Dynamic, 1 > Vector
#define TEST(TITLE, STATEMENT)
Jet< T, N > sqrt(const Jet< T, N > &f)
gtsam
Author(s):
autogenerated on Sat Nov 16 2024 04:09:01