LieGroups/SE3/Generic/leftInvariantError.mo

Download original .moGitHub source

Documentation: LieGroups.SE3.Generic.leftInvariantError

within LieGroups.SE3.Generic;
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;