Screw Theory Cedric Fischer and Michael Mattmann Institute of - PowerPoint PPT Presentation

Screw Theory Cedric Fischer and Michael Mattmann Institute of Robotics and Intelligent Systems Department of Mechanical and Process Engineering (DMAVT) ETH Zurich

Screw Theory Every rigid body motion can be expressed by a rotation about an axis combined with a translation parallel to that axis. (= screw motion) Method is based on rigid body motion instead of location!  Time dependent now! Different ways to describe it: - screws (geometrical description: screw parameter) - twists (mathematical description: abstract) - product of exponentials (mathematical description: homogeneous) 2

Screw Theory: Geometrical Description l M h Screw parameters  Pitch h  Ratio of translational motion to rotational motion  Axis l  Axis of rotation, line through a point  Direction of translation  Magnitude M  Amount of displacement  Net rotation and/or translation 3

Screw Theory: Mathematical Description é ù é ù a 2 b 3 - a 3 b 2 - a 3 0 a 2 ê ú ê ú a ´ b = ˆ ab = ê 1 - a 1 b 3 ú = ê - a 1 ú a 3 b a 3 0 b Skew-symmetric matrix ê ú ê ú a 1 b 2 - a 2 b - a 2 a 1 0 ê ú ê ú ë û ë û 1  Twist Coordinates  Twist  6x1 vector  4x4 matrix General description with Derivation: page 39 – A Mathematical Introduction to Robotic Manipulation 1994 4

Screw Theory: Mathematical Description é ù é ù a 2 b 3 - a 3 b 2 - a 3 0 a 2 ê ú ê ú a ´ b = ˆ ab = ê 1 - a 1 b 3 ú = ê - a 1 ú a 3 b a 3 0 b Skew-symmetric matrix ê ú ê ú a 1 b 2 - a 2 b - a 2 a 1 0 ê ú ê ú ë û ë û 1  Twist Coordinates  Twist  6x1 vector  4x4 matrix é ù é ù - w ´ q w ˆ - w ´ q ˆ ê ú x = x = ê ú ê w ú ê ú 0 0 ë û ë û Revolute joint é ù é ù v 0 v ˆ x = x = ê ú ê ú 0 0 0 ë û ë û Prismatic joint Derivation: page 39 – A Mathematical Introduction to Robotic Manipulation 1994 5

Rodrigues’ Formula  All rotation matrices can be written as a matrix exponential of a skew-symmetric matrix! wq = I + ˆ 2 1 - cos q ( ) ˆ w sin q + ˆ w e  Rodrigues’ Formula: Proof on extra slide! é ù ( ) w ´ v  Homogeneous ( ) + h qw wq ˆ I - e wq ˆ e xq = ê ú ˆ Transformation e ê ú  4x4 matrix 0 1 ë û Revolute joint Prismatic joint é ù ( ) w ´ v é ù ( ) wq wq ˆ I - e ˆ e q v xq = xq = I ê ú ˆ ˆ e e ê ú ê ú 0 1 ë û 0 1 ë û 6

Screw Theory: Mathematical Description If a coordinate frame B is attached to a rigid body undergoing a screw motion, the instantaneous configuration of the coordinate frame B, relative to a fixed frame A, is given by g(0): - all joint angles defined as being zero - Describes transformation from the base frame to tool frame This transformation can be interpreted as follows: - multiplication by gab(0) maps the coordinates of a point relative to the B frame into A’s coordinates - the exponential map transforms the point to its final location (still in A coordinates). 7

Assignment 3 Two systems: System 1:  a) g(0)  Rotation and translation between CS  b) Pitch, axis and magnitude System 2:  c) Twist and twist coordinates  d) Find total homogeneous transformation g 12  e) Matlab: use twist, twistexp  plot trajectories of P1,P2,P3 ( g(θ)*P i ) 9

Kinematics Toolbox • Figure, chart, video… skew Point Rotation axis Skew-symm. matrix skewlog w w ^ q skewcoords Rotation matrix R skewexp createtwist twistmagnitude Magnitude M Twist Coord. Twist twist twistlog Axis twistaxis [6x1] [4x4] l twistcoords x x ^ Pitch h twistpitch Hom. Transf. [4x4] twistexp g 10