A function to calculate the initial position and orientation angle of a free-floating beam. The beam is assumed to hang at the bottom intersection between two cloths. The function takes in the four points that would be used to define a "bent cloth" of the same configuration and uses the algorithm developed to calculate the positions of the outside bottom points of a hanging cloth (see cloth_bend documentation). These points are taken to be the end points of the beam. The orientation angles are calculated from these end points.
Copyright © 2018
ATA ENGINEERING, INC.
ALL RIGHTS RESERVED
function ZipperLocInitializer import Modelica.Math.Vectors; import Modelica.Mechanics.MultiBody.Frames; import Modelica.Utilities.Streams.print; import Modelica.Constants.pi; input Real[3] P1; input Real[3] P2; input Real[3] P3; input Real[3] P4; input Integer M, N; input Real start_angle; input Real[3] P_ref "Center of arc in which P1, P2, etc. are defined"; input Frames.Orientation P_R "Absolute orientation of P_ref in space"; final input Boolean debug = false; output Real[3, 3] B; end ZipperLocInitializer;