Expand description
Lie-group utilities used by estimation and optimization algorithms.
Tangent vectors use translation-first ordering throughout this module:
[vx, vy, omega] for SE(2), and
[vx, vy, vz, omega_x, omega_y, omega_z] for SE(3).
The implementation follows the closed-form exponential, logarithm, and Jacobian expressions used by MathematicalRobotics, with explicit series expansions around zero and a stable SO(3) logarithm around pi.
Functions§
- se2_
adjoint - Adjoint matrix of an SE(2) transform for translation-first tangents.
- se2_exp
- Exponential map from se(2) to a homogeneous SE(2) matrix.
- se2_
inverse - Inverse of a homogeneous SE(2) matrix.
- se2_log
- Logarithm map from a homogeneous SE(2) matrix.
- se3_
adjoint - Adjoint matrix of an SE(3) transform for translation-first tangents.
- se3_exp
- Exponential map from se(3) to a homogeneous SE(3) matrix.
- se3_
inverse - Inverse of a homogeneous SE(3) matrix.
- se3_log
- Logarithm map from a homogeneous SE(3) matrix.
- skew
- Returns the 3x3 skew-symmetric matrix for a vector.
- so2_exp
- Exponential map from so(2) to SO(2).
- so2_log
- Logarithm map from SO(2) to so(2), returning an angle in
[-pi, pi]. - so3_exp
- Exponential map from so(3) to SO(3).
- so3_
left_ jacobian - Left Jacobian of SO(3).
- so3_
left_ jacobian_ inverse - Inverse of the SO(3) left Jacobian.
- so3_log
- Logarithm map from SO(3) to the principal so(3) tangent vector.
- unskew
- Extracts a vector from the skew-symmetric part of a 3x3 matrix.