residue = Orientation.equalityConstraint(R1, R2);
The function call
Orientation.equalityConstrain(R1,R2)
returns the Real residue vector with 3 elements. This vector has
zero elements if orientation objects R1 and R2 are identical (=
describe the same orientation). The residue vector is determined by
computing the relative orientation object between R1 and R2 and
using the outer-diagonal elements of this matrix to formulate the
residue in such a way that only identical orientation objects lead
to a zero residue vector.
encapsulated function equalityConstraint import Modelica; import Modelica.Mechanics.MultiBody.Frames; extends Modelica.Icons.Function; input Frames.Orientation R1 "Orientation object to rotate frame 0 into frame 1"; input Frames.Orientation R2 "Orientation object to rotate frame 0 into frame 2"; output Real residue[3] "The rotation angles around x-, y-, and z-axis of frame 1 to rotate frame 1 into frame 2 for a small rotation (should be zero)"; end equalityConstraint;