|
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 mass component models a mass and angular inertia
in a multibody dynamics chain.
The mass takes the input position, velocity, and
acceleration from Side 3 and directly outputs them on
Side 1
The joint also takes the internal force and moment
from Side 1 and adds in the internal force and moment
generated by the mass and outputs it on Side 3. The
internal force and moment is calculated based on the
perturbation of each degree of freedom. In addition it
calculates the default internal forces and moments due
to gravity, velocity, and external forces.
|