CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

function

LieGroups.SE3.Generic.leftInvariantError

Log(reference^(-1) actual), a local error coordinate for analysis

Public declarations

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

RoleNameTypeDimensions / attributes / defaultDescription
inputreferenceElement
inputactualElement
outputtangentReal[6]

Modelica declarations and implementation

Show parameters, interfaces and source

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

function leftInvariantError
  "Log(reference^(-1) actual), a local error coordinate for analysis"
  input Element reference;
  input Element actual;
  output Real tangent[6];
algorithm
  tangent := log_map(product(inverse(reference), actual));
end leftInvariantError;