ASME DETC Background Twists in Kinematics and Wrenches in Statics Vijay Kumar

ASME DETC Background Rigid Body Motion P(t) = R(t) p + d(t) R3  3 rotation matrix d3  1 translation vector Alternatively, The motion of a rigid body is described by the matrix function of time

ASME DETC Rigid Body Velocity Rigid Body Motion P(t) = R(t) p + d(t)  t) angular velocity matrix v O  t) velocity of a point on the rigid body coincident with the origin The velocity of the rigid body is described by  t) and v O  t).

ASME DETC Velocity and Twist Twist A 6  1 velocity vector: Or, a 4  4 velocity matrix: The twist of the rigid body contains all information about the instantaneous velocity of the rigid body. The velocity of any point on the rigid body is simply:

ASME DETC Instantaneous Screw Axis (ISA) There is a unique (screw) axis and a pitch associated with any twist vector. Let u be a unit vector so that:  u Decompose v O into components parallel and perpendicular to u: v O = v parallel + v perpendicular Let v parallel = h u, and define a vector  so that: v perpendicular =    Any twist vector can be written as: ( , u) define the axis l h is the pitch of the axis  is the intensity of the twist about the ISA. u O 

ASME DETC ISA, continued The Instantaneous screw axis (ISA) is described by: l u, the orientation of the axis , the position vector to a point on the axis h, the pitch of the axis The rigid body velocity can be thought of as a twist about a screw axis with a certain amplitude.  amplitude of the twist - the vector representing the axis The twist vector is written as: u O 

ASME DETC Velocity field associated with a rigid body Instantaneous screw axis and the helicoidal vector field The velocity field or the set of all velocity vectors forms a helicoidal vector field. Let the origin be on the instantaneous screw axis corresponding to the twist. The velocity of any point P consists of a component parallel to the instantaneous screw axis and another velocity component normal to it. The velocity component normal to the screw axis is also normal to the normal from the point to the screw axis and is proportional both to the length of that normal and to the angular velocity, . It can be represented by the expression   q, where q is the normal vector from the screw axis to the point. Oq  q hh Helix of pitch h and axis S passing through the point P P vPvP

ASME DETC Screws of zero and infinite pitch Revolute joint The motion of the rigid body due to a revolute joint can be described as a twist about a screw of zero pitch. Prismatic joint Axis  y z O u u = [0, 0, 1] T,  = [a, b, c] T,  u = [b, -a, 0] T Axis y z O u d u = [0, 0, 1] T The motion of the rigid body due to a prismatic joint can be described as a twist about a screw of infinite pitch.

ASME DETC What is a Wrench? Any system of forces and couples can be reduced to a pure force along an axis l, and a pure couple parallel to l. This combination of a force and a couple is called a wrench.

ASME DETC Wrenches l Resultant force and couple l Equipollent to a force F along l and a couple C parallel to l

ASME DETC Screw Axis for a Wrench The screw axis is described by: l u, the orientation of the axis , the position vector to a point on the axis h, the pitch of the axis The system of forces and couples can be thought of as a wrench about a screw axis with a certain intensity. F  intensity of the wrench - the vector representing the axis Any system of forces and couples can be reduced to a wrench vector which can be written as: u O 

ASME DETC Lines and Plucker Line Coordinates Any line can be represented by 6 coordinates (L, M, N, P, Q, R) where (L, M, N) T = v; (P, Q, R) T = (   v). Note there are only four independent coordinates: l LP + MQ + NR = 0 (L, M, N, P, Q, R)  (kL, kM, kN, kP, kQ, kR) A line can be written in the form where h=0.

ASME DETC Screws and Lines l An instantaneous screw axis or simply a screw is a line with a pitch associated with it. l A zero pitch screw can be identified with a line. l An infinite pitch screw can be identified with a line located at infinity.

ASME DETC Lines in Kinematics and Statics A body subject to a pure force along the axis l l A pure force is a wrench of zero pitch l We can represent the force by a line. A body instantaneously undergoing a pure rotation about the axis l l A pure rotation is a twist of zero pitch l We can represent the rotation by a line

ASME DETC Lines in Kinematics and Statics (Cont’d) A body subject to a pure couple l A pure couple is a wrench of infinite pitch l We can represent the couple by a line at infinity A body instantaneously undergoing a pure translation l A pure translation is a twist of infinite pitch l We can represent the translation by a line at infinity

ASME DETC Example Two revolute joints in series l Screw axis for Joint 1 Axis 1 Axis 2 P a1a1 a2a2 22 11 y z O l Screw axis for Joint 2 u2u2 u1u1

ASME DETC Background: Open Chain Linkages System of screws: Open chain linkages Let the end effector twist be T. Consider two joints, 1 & 2. The effect of twists about two joints connected in series is to produce a composite twist that is obtained by adding the two twists (in the same coordinate system). Axis 1 Axis 2 y z O u2u2 u1u1 x Axis n

ASME DETC Background: Closed Chain Linkages System of screws: Open chain linkages The effect of twists about n joints connected in series is to produce a composite twist that is obtained by adding the n joint twists (in the same coordinate system). Axis 1 Axis 2 y z O u2u2 u1u1 x Axis n

ASME DETC Background: Closed chain linkages System of screws for a closed chain Consider a closed loop linkage with n joints. The twist of Link n-1 is given by: If the twist of joint n is T n, In other words, Axis 1 Axis 2 y z O u2u2 u1u1 x Axis n-1 Axis n Link n-1 Link 1 Link 0 l The sum of the twists for all joints in a closed chain equals zero. l The joint twist in a closed chain is obtained from the other joint twists by simply adding (or subtracting) them.