Homogeneous Transformations

Transcription

1 Purpose: Homogeneous Transformations The purpose of this chapter is to introduce you to the Homogeneous Transformation. This simple 4 x 4 transformation is used in the geometry engines of CAD systems and in the kinematics model in robot controllers. It is very useful for examining rigid-body position and orientation (pose) of a sequence of robotic links and joint frames.

2 In particular, you will. Examine the structure of the HT (homogeneous transform). 2. See how orientation and position are represented within one matrix. 3. Apply the HT to pose (position and orient) a frame (xyz set of axes) relative to another reference frame. 4. Examine the HT for simple rotations about an axis. 5. See the effect of multiplying a series of HT s. 6. Interpret the order of a product of HT s relative to base and body-fixed frames. 7. See how the HT is used in robotics.

3 Script Notation: Pre super and sub-scripts are often used to denote frames of reference B T C = transformation of frame C relative to frame B C p = vector located in frame C Tsai uses a pre and post script notation B T C = transformation of frame C relative to frame B C p = vector located in frame C Note that we may not use the scripting approach, but instead graphically interpret the frame representations.

4 Homogeneous Transformation a x b x c x p x H = a y a z b y b z c y c z p y p z d d 2 d 3 H can represent translation, rotation, stretching or shrinking (scaling), and perspective transformations

5 Interpreting the HT as a frame a b c p R a x b x c x p x H = a y a z b y b z c y c z p y p z a, b, and c form an orientation sub-matrix denoted by R (3 x 3), while p (3 x ) is the frame s origin offset.

6 What do the terms represent? a is a vector ( set of direction cosines a x, a y, and a z ) that orients the frame s x axis relative to the base X, Y, and Z axes, respectively. Similar interpretations are made for the frame s y and z axes through the direction cosine sets represented by vectors b and c. p is a vector of 3 components representing the frame s origin relative to the reference axes. a = p Base frame a x a y a z Frame

7 Interpreting the HT used to locate a vector in the base frame Given a fixed vector u, its transformation v is represented by z H v u v = H u Note that this form doesn t work for free vectors! x y Frame Interpretation

8 Transforming vectors The position vector u having components u x, u y, u z must be expanded to a 4 x vector by adding a. u = u x u y u z Note: To transform an orientation vector, only use the orientation sub-matrix R, and drop the from the vector so that you are multiplying a (3 x 3) matrix times a (3 x ) vector.

9 Interpreting the HT v = R p u x u y = R u + p u T z The adds in the frame origin, while the R resolves the vector u into the base frame

10 Special cases: Pure rotation H = a x b x c x a y b y c y a z b z c z

11 Special cases: p x Pure translation H = p y p z

12 Rotational forms Pure rotation about x R(x, θ) = cosθ sinθ -sinθ cosθ θ θ x

13 Rotational forms cosθ sinθ Pure rotation about y R(y, θ) = -sinθ cosθ cosθ -sinθ Pure rotation about z R(z, θ) = sinθ cosθ

14 Example - Rotate u by 9 o about +Z and 9 o about +Y, where XYZ are the fixed base reference axes. What are the final coordinates of the vector u after these two rotations in the base XYZ axes? If the rotation order changed, will the final coordinates be the same? Let u T = [ ]. Soln: Thus, v = R (Z,9 ) u "rotate u to v" w = R (Y,9 ) v "rotate v to w" w = R (Y,9 ) R (Z,9 ) u

15 R(Y,9 ) = - - R(Z,9 ) =

16 w = = Graphical interpretation Z, z', y" Y, x', x" X,z" 9 9 y' (,,) (,,)

17 w = = Change order? Not commutative!

18 Order of p and R: first R, then p w = H(p) H(R) u = I p T w = R p T u = H (R, p) u R T u R p

19 Order of p and R: first p, then R w = H(R) H(p) u = R T I p T u = R Rp T u R Note the difference in the final matrix form. Can you explain the difference? p

20 Understanding HT multiplication order If we postmultiply a transformation (A B) representing a frame (relative to base axes) by a second transformation (relative to the frame of the first transformation), we make the transformation with respect to the frame axes of the first transformation. Premultiplying the frame transformation by the second transformation (B A) causes the transformation to be made with respect to the base reference frame.

21 Example -Given frame C = and transformation H = locate frame X = H C and frame Y = C H. Note the differences.

22 Results : HC X = HC = H - C 2 - = 2 Z y' z 2 y C X z" y" z' x" x' Y X x

23 Results : CH Y = C Z H = z x y C 2 Y X z Y y x

24 Inverse Transformations Given u and the rotational transformation R, the coordinates of u after being rotated by R are defined by v = Ru. The inverse question is given v, what u when rotated by R will give v? Answer: u = R - v = R T v

25 Inverse Transformations Similarly for any displacement matrix H (R, p), we can pose a similar question to get u = H - v. What is the inverse of a displacement transformation? Without proof: a x a y a z -p T a H - = b x b y b z -p T b c x c y c z -p T c = R T -R T p T

26 Operational rules for square matrices of full rank : (A B C ) T = C T B T A T (A B C ) - = C - B - A -

27 HT summary Homogeneous transformation consists of three components: rotational, orthogonal 3x3 sub-matrix which is comprised of columns of direction cosines used to orient the axes of one frame relative to another. column vector in 4th column represents the origin of second frame relative to first frame, resolved in the first frame. 's in 4 th row except for in 4,4 position.

28 HT summary The homogeneous transformation effectively merges a frame orientation matrix and frame translation vector into one matrix. The order of the operation should be viewed as rotation first, then translation.

29 HT summary The homogeneous transformation can be viewed as a position/orientation relationship of one frame relative to another frame called the reference frame.

30 HT summary A B can be interpreted as frame A described relative to the first or base frame while frame B is described relative to frame A (usual way). We can also interpret B in the base frame transformed by A in the base frame. Both interpretations give same result.