Go to the documentation of this file.
9 #ifndef MRPT_SE3_TRAITS_H
10 #define MRPT_SE3_TRAITS_H
31 enum { VECTOR_SIZE = 6 };
47 static void pseudo_ln(
const CPose3D &P, array_t &x);
54 static void jacobian_dP1DP2inv_depsilon(
57 matrix_VxV_t *df_de2);
64 enum { VECTOR_SIZE = 3 };
88 static void jacobian_dP1DP2inv_depsilon(
91 matrix_VxV_t *df_de2);
static CPose3D exp(const mrpt::math::CArrayNumeric< double, 6 > &vect, bool pseudo_exponential=false)
Exponentiate a Vector in the SE(3) Lie Algebra to generate a new CPose3D (static method).
static void pseudo_ln(const CPose2D &P, array_t &x)
A pseudo-Logarithm map in SE(2), where the output = [X,Y, Ln(ROT)], that is, the normal SO(2) logarit...
static void exp(const array_t &x, CPose3D &P)
Exponential map in SE(3), with XYZ different from the first three values of "x".
void ln(mrpt::math::CArrayDouble< 6 > &out_ln) const
Take the logarithm of the 3x4 matrix defined by this pose, generating the corresponding vector in the...
static void pseudo_exp(const array_t &x, CPose2D &P)
Pseudo-Exponential map in SE(2), in this case identical to exp()
mrpt::math::CMatrixFixedNumeric< double, VECTOR_SIZE, VECTOR_SIZE > matrix_VxV_t
static void ln(const CPose3D &P, array_t &x)
Logarithm map in SE(3)
const double & phi() const
Get the phi angle of the 2D pose (in radians)
mrpt::math::CArrayDouble< VECTOR_SIZE > array_t
static void exp(const array_t &x, CPose2D &P)
Exponential map in SE(2)
This is the global namespace for all Mobile Robot Programming Toolkit (MRPT) libraries.
struct BASE_IMPEXP SE_traits
A helper class for SE(2) and SE(3) geometry-related transformations, on-manifold optimization Jacobia...
mrpt::math::CMatrixFixedNumeric< double, VECTOR_SIZE, VECTOR_SIZE > matrix_VxV_t
static void ln(const CPose2D &P, array_t &x)
Logarithm map in SE(2)
A class used to store a 2D pose.
double x() const
Common members of all points & poses classes.
A class used to store a 3D pose (a 3D translation + a rotation in 3D).
mrpt::math::CArrayDouble< VECTOR_SIZE > array_t
A partial specialization of CArrayNumeric for double numbers.
A numeric matrix of compile-time fixed size.
static void pseudo_exp(const array_t &x, CPose3D &P)
Pseudo-Exponential map in SE(3), with XYZ copied from the first three values of "x".
Page generated by Doxygen 1.8.16 for MRPT 1.4.0 SVN: at Mon Oct 14 23:11:08 UTC 2019 | | |