CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

function

LieGroups.SE3.Quat.vee

Homogeneous se(3) matrix to tangent vector

Public declarations

Explicit source declarations; dimensions, modifications and defaults are shown as written, without evaluation.

RoleNameTypeDimensions / attributes / defaultDescription
inputmatrixRepresentationReal[4, 4]
outputtangentReal[6]

Modelica declarations and implementation

Show parameters, interfaces and source

Parameters, inputs, outputs, defaults and equations from the source file.

function vee "Homogeneous se(3) matrix to tangent vector"
  input Real matrixRepresentation[4, 4];
  output Real tangent[6];
algorithm
  tangent[1:3] := matrixRepresentation[1:3, 4];
  tangent[4:6] := LieGroups.SO3.Quat.vee(matrixRepresentation[1:3, 1:3]);
end vee;