|
GTSAM
4.0.2
C++ library for smoothing and mapping (SAM)
|
Functor that implements Exponential map and its derivatives. More...
#include <SO3.h>


Public Member Functions | |
| GTSAM_EXPORT | DexpFunctor (const Vector3 &omega, bool nearZeroApprox=false) |
| Constructor with element of Lie algebra so(3) | |
| const Matrix3 & | dexp () const |
| GTSAM_EXPORT Vector3 | applyDexp (const Vector3 &v, OptionalJacobian< 3, 3 > H1={}, OptionalJacobian< 3, 3 > H2={}) const |
| Multiplies with dexp(), with optional derivatives. | |
| GTSAM_EXPORT Vector3 | applyInvDexp (const Vector3 &v, OptionalJacobian< 3, 3 > H1={}, OptionalJacobian< 3, 3 > H2={}) const |
| Multiplies with dexp().inverse(), with optional derivatives. | |
| SO3 | expmap () const |
| Rodrigues formula. | |
Protected Member Functions | |
| void | init (bool nearZeroApprox=false) |
Protected Attributes | |
| const double | theta2 |
| Matrix3 | W |
| Matrix3 | K |
| Matrix3 | KK |
| bool | nearZero |
| double | theta |
| double | sin_theta |
| double | one_minus_cos |
Functor that implements Exponential map and its derivatives.
1.8.13