Assert that angles are equal
function equalityConstraint extends Modelica.Icons.Function; input ReferenceAngle theta1[:]; input ReferenceAngle theta2[:]; output Real residue[0]; end equalityConstraint;