function

LieGroups.SE3.Quat.left_jacobian

Left Jacobian of SE(3)

Public declarations

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

Role	Name	Type	Dimensions / attributes / default	Description
input	`tangent`	`Real`	`[6]`
output	`J`	`Real`	`[6, 6]`

Modelica declarations and implementation

Show parameters, interfaces and source

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

function left_jacobian "Left Jacobian of SE(3)"
  input Real tangent[6];
  output Real J[6, 6];
protected
  Real rotationJ[3, 3];
algorithm
  rotationJ := LieGroups.SO3.Quat.left_jacobian(tangent[4:6]);
  J := zeros(6, 6);
  J[1:3, 1:3] := rotationJ;
  J[1:3, 4:6] := LieGroups.SE3.Quat.left_Q(tangent[1:3], tangent[4:6]);
  J[4:6, 4:6] := rotationJ;
end left_jacobian;