NewtonianFrame  N
RigidBody       A, B, C
Point           Q
%--------------------------------------------
Constant  LA = 0.4 m,  LB = 0.3 m,  LC = 0.2 m
qA = sin(t)
qB = sin(2*t)
qC = sin(3*t)

%--------------------------------------------
%   Rotational and translational kinematics
A.RotateZ( N, qA )
B.RotateX( A, qB )
C.RotateX( B, qC )
Q.Translate( No, LA*Az> + LB*By> + LC*Cy> )

%--------------------------------------------
%   Magnitudes of Q's position, velocity, and acceleration at time t = 1.
PositionMagnitude = EvaluateToNumber( Q.GetDistance(No),  t = 1 )
VelocityMagnitude = EvaluateToNumber( Q.GetSpeed(N),      t = 1 )
AccelerationMagnitude = EvaluateToNumber( Magnitude( Q.GetAcceleration(N) ),  t = 1 )

Save MGRobotStanfordArmKinematicsOnly.html
Quit