Skip to main content

Module lie

Module lie 

Source
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.

Type Aliases§

Matrix6
A 6x6 matrix acting on an SE(3) tangent vector.
Vector6
A six-dimensional SE(3) tangent vector in translation-first order.