gtsam
4.0.0
gtsam
|
Functor that implements Exponential map and its derivatives.
Public Member Functions | |
DexpFunctor (const Vector3 &omega, bool nearZeroApprox=false) | |
Constructor with element of Lie algebra so(3) | |
const Matrix3 & | dexp () const |
Vector3 | applyDexp (const Vector3 &v, OptionalJacobian< 3, 3 > H1=boost::none, OptionalJacobian< 3, 3 > H2=boost::none) const |
Multiplies with dexp(), with optional derivatives. | |
Vector3 | applyInvDexp (const Vector3 &v, OptionalJacobian< 3, 3 > H1=boost::none, OptionalJacobian< 3, 3 > H2=boost::none) const |
Multiplies with dexp().inverse(), with optional derivatives. | |
Public Member Functions inherited from gtsam::so3::ExpmapFunctor | |
ExpmapFunctor (const Vector3 &omega, bool nearZeroApprox=false) | |
Constructor with element of Lie algebra so(3) | |
ExpmapFunctor (const Vector3 &axis, double angle, bool nearZeroApprox=false) | |
Constructor with axis-angle. | |
SO3 | expmap () const |
Rodrigues formula. | |
Additional Inherited Members | |
Protected Member Functions inherited from gtsam::so3::ExpmapFunctor | |
void | init (bool nearZeroApprox=false) |
Protected Attributes inherited from gtsam::so3::ExpmapFunctor | |
const double | theta2 |
Matrix3 | W |
Matrix3 | K |
Matrix3 | KK |
bool | nearZero |
double | theta |
double | sin_theta |
double | one_minus_cos |