Ticket #6200: PrismaticConstraint.mo

within ;
model PrismaticConstraint
  "Body attached by one spring and two prismatic joints or constrained to environment"
  extends Modelica.Icons.Example;
  parameter Boolean animation=true "True, if animation shall be enabled";

  Modelica.Mechanics.MultiBody.Joints.Constraints.Prismatic constraint(x_locked=
        false, y_locked=false)
    annotation (Placement(transformation(extent={{60,10},{40,30}})));
  Modelica.Mechanics.MultiBody.Sensors.RelativeSensor sensorConstraintRelative(
    resolveInFrame=Modelica.Mechanics.MultiBody.Types.ResolveInFrameAB.frame_a,
    get_r_rel=true,
    get_a_rel=false,
    get_angles=true)
    annotation (Placement(transformation(extent={{60,60},{40,40}})));
  Modelica.Mechanics.MultiBody.Parts.BodyShape bodyOfConstraint(
    I_11=1,
    I_22=1,
    I_33=1,
    width=0.05,
    w_0_fixed=false,
    final color={0,128,0},
    r={0.4,0,0},
    r_CM={0.2,0,0},
    m=1,
    angles_fixed=false,
    angles_start={0.17453292519943,0.95993108859688,1.1868238913561})
    annotation (Placement(transformation(extent={{-10,10},{10,-10}},rotation=180,
        origin={-10,20})));
  Modelica.Mechanics.MultiBody.Forces.Spring springOfConstraint(
    width=0.1,
    coilWidth=0.005,
    c=20,
    s_unstretched=0,
    numberOfWindings=5) annotation (Placement(transformation(
        origin={-50,20},
        extent={{-10,-10},{10,10}})));
  inner Modelica.Mechanics.MultiBody.World world(enableAnimation=false)
                                                 annotation (Placement(
        transformation(extent={{-100,-100},{-80,-80}})));
  Modelica.Mechanics.MultiBody.Parts.FixedRotation fixedRotation(
    r={0.2,-0.3,0.2},
    rotationType=Modelica.Mechanics.MultiBody.Types.RotationTypes.PlanarRotationSequence,
    angles={10,55,68})
    annotation (Placement(transformation(extent={{-10,-10},{10,10}},
        rotation=90,
        origin={90,-50})));

  Modelica.Mechanics.MultiBody.Parts.FixedTranslation fixedTranslation(animation=
       false, r={0.8,0,0.3})
    annotation (Placement(transformation(extent={{-10,-10},{10,10}},
rotation=90,
        origin={-70,-50})));
  Modelica.Mechanics.MultiBody.Joints.FreeMotionScalarInit freeMotionScalarInit(
    use_r=true,
    use_v=true,
    v_rel_a_2(fixed=true, start=0),
    v_rel_a_3(fixed=true, start=0),
    use_w=true,
    w_rel_b_1(fixed=false),
    w_rel_b_2(fixed=false),
    w_rel_b_3(fixed=false),
    angle_d_3(fixed=false),
    r_rel_a_2(fixed=true, start=0),
    r_rel_a_3(fixed=true, start=0),
    angle_1(fixed=false))
    annotation (Placement(transformation(extent={{60,70},{40,90}})));
equation
  connect(fixedTranslation.frame_a, world.frame_b)
    annotation (Line(
      points={{-70,-60},{-70,-90},{-80,-90}},
      color={95,95,95},
      thickness=0.5));
  connect(bodyOfConstraint.frame_b, springOfConstraint.frame_b)
                                         annotation (Line(
      points={{-20,20},{-40,20}},
      color={95,95,95},
      thickness=0.5));
  connect(world.frame_b, fixedRotation.frame_a) annotation (Line(
      points={{-80,-90},{90,-90},{90,-60}},
      color={95,95,95},
      thickness=0.5));
  connect(fixedRotation.frame_b, constraint.frame_a) annotation (Line(
      points={{90,-40},{90,20},{60,20}},
      color={95,95,95},
      thickness=0.5));
  connect(constraint.frame_a,sensorConstraintRelative. frame_a)
                                                      annotation (Line(
      points={{60,20},{70,20},{70,50},{60,50}},
      color={95,95,95},
      thickness=0.5));
  connect(sensorConstraintRelative.frame_b, constraint.frame_b) annotation (
      Line(
      points={{40,50},{30,50},{30,20},{40,20}},
      color={95,95,95},
      thickness=0.5));
  connect(fixedTranslation.frame_b, springOfConstraint.frame_a)
                                                   annotation (Line(
      points={{-70,-40},{-70,20},{-60,20}},
      color={95,95,95},
      thickness=0.5));
  connect(bodyOfConstraint.frame_a, constraint.frame_b) annotation (Line(
      points={{0,20},{40,20}},
      color={95,95,95},
      thickness=0.5));
  connect(freeMotionScalarInit.frame_a, fixedRotation.frame_b) annotation (
      Line(
      points={{60,80},{90,80},{90,-40}},
      color={95,95,95},
      thickness=0.5));
  connect(freeMotionScalarInit.frame_b, bodyOfConstraint.frame_a) annotation (
     Line(
      points={{40,80},{10,80},{10,20},{0,20}},
      color={95,95,95},
      thickness=0.5));
  annotation (
    experiment(StopTime=10),
    Documentation(info="<html>
<p>This example demonstrates the functionality of <strong>constraint</strong> representing <strong>prismatic joint</strong>. Each of two bodies is at one of its end connected by spring to the world. The other end is also connected to the world either by two serial coupled prismatic joints or by appropriate constraint. Therefore, the body can only perform translation in two directions specified in the two joints depending on working forces.</p>
<p><strong>Simulation results</strong></p>
<p>After simulating the model, see the animation of the multibody system and compare movement of body connected by joint (blue colored) with movement of that one connected by constraint (of green color). Additionally, the outputs from <code>sensorConstraintRelative</code> depict both position and angle deviations in the constraining element.</p>
</html>"),
    uses(Modelica(version="3.2.3")));
end PrismaticConstraint;