|
Coordinate System: The coordinate system is
right hand rule. X cross Y gives Z and Roll is right
hand rule about X, Pitch is right hand rule about Y, and
Yaw is right hand rule about Z.
Vector Storage:
All linear three vectors (LinPos, LinVel) store their
values as [X, Y, Z].
All angular three vectors (AngVel)
store their values as [Roll, Pitch, Yaw].
The
transformation matrix TM is stored:

Pre-multiplying a local vector by the TM will generate
the vector in global coordinates.
Multibody Dynamics, Link Numbers and 60 and 20 Length
Vectors:
Please refer to
Multibody Dynamics and 60 Length Vectors for
information on 60
length vectors.
Methodology:
The screw component models a screw mechanism.
LocalJointAxis defines the axis about which the body
rotates. The LocalJointAxis is defined in the local
coordinates of the upstream body's coordinate system.
GearRatio defines how much linear motion is generated
relative to angular motion.
The screw takes the input position, velocity, and
acceleration from Side 3 adds in the linear and
rotational position, velocity and acceleration of the
joint and outputs the results on Side 1.
The screw also takes the internal force and moment
from Side 1 and outputs it on Side 3.
A new link number is requested from the multibody
solver and this is added to the list of link
numbers in LinkNumber3 and output in LinkNumber1.
The screw calculates the torque generated about the
joint due to the perturbation of each degree of freedom.
In addition it calculates the default torque due to
gravity, velocity, and external forces. The external
torque applied to the joint through ExternalJointTorque
is added
to the default torque.
The multibody solver calculates the actual joint
acceleration, which is integrated and output in
JointAng, JointAngRate, JointVel and JointPos.
|