![Page 1: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/1.jpg)
Homogeneous Transformation MatricesExample: Puma 560
©2017 Max Donath
![Page 2: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/2.jpg)
Position and Orientation of End Effector
![Page 3: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/3.jpg)
Homogeneous Transformation
4 x 4 Matrix
Accounts for body Rotation
Translation
Columns Specify the directions of the body’s coordinate axes
Translation Vector
![Page 4: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/4.jpg)
Calculation of Position and Orientation
in World Coordinates from the Joint Angles:
For a manipulator:Base A hand = Base T Hand Origin x Hand OriginAHand
For a six-jointed manipulator:Base T Hand Origin = BaseA1 x 1A2 x 2A3 x 3A4 x 4A5 x 5AHand origin
Where:N-1A n= Homogeneous transformation matrix which relates the coordinate frame of link n to the coordinate frame of link n-1
![Page 5: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/5.jpg)
X2 behind Y2Z2 planeX3 behind Y3Z3 planeY4 behind X4Z4 plane
![Page 6: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/6.jpg)
Homogeneous Transformation-combines rotation and translation
Definition: ref H loc = homogeneous transformation matrix which defines a location (position and orientation) with respect to a reference frame
Sequential TransformationsTranslate by x, y, zYaw: Rotate about Z, by (270˚ + q)Pitch: Rotate about Y’ by (a + 90˚)Roll: Rotate about Z” by t
,y
![Page 7: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/7.jpg)
Step A: Translation by x, y, z
World Coordinate System
![Page 8: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/8.jpg)
Step B: Rotation about Z (vertical axis) by 270˚
(shift coordinate frames to align X’Y’ for q = 0º orientation angle or yaw)
![Page 9: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/9.jpg)
Step C: Rotation about Z (vertical axis) by q˚
![Page 10: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/10.jpg)
Step D: Rotation about Y’ (orientation vector)by 90˚ (shift coordinate frames to align Z”X” for α = 0º approach angle or pitch)
![Page 11: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/11.jpg)
Step E: Rotation about Y’ (Orientation Vector)by a˚ from horizontal plane to Z” for τ = 0° tool angle or roll
![Page 12: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/12.jpg)
Step F: Rotation about Z” (approach vector)by t˚
![Page 13: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/13.jpg)
![Page 14: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/14.jpg)
![Page 15: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/15.jpg)
Calculation of homogeneous transformation matrix from position and orientation in world coordinates
![Page 16: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/16.jpg)
![Page 17: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/17.jpg)
Homogeneous Transformation Matrices:Significance of columns and rows
![Page 18: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/18.jpg)
Linear transformation which provides the geometric relationship between two coordinate systems:
Nx Ox Ax PxNy Oy Ay PyNz Oz Az Pz0 0 0 1
Nx - Cosine of the angle between N and X
Ny - Cosine of the angle between N and Y
Nz - Cosine of the angle between N and Z
NxNy = Unit vector describing direction of NNz
Similar definitions for and
P = = Position vector relating origins of coordinate systems
T =Initial coordinate system X Y Z
Final coordinate system N O A
Ox
Oy
Oz
Ax
Ay
AzPx
Py
Pz
![Page 19: Homogeneous Transformation Matrices Example: Puma 560me.umn.edu/courses/me5286/manipulator/LectureNotes/2017/ME5286Course... · Hand Origin x Hand OriginA Hand For a six-jointed manipulator:](https://reader030.vdocuments.us/reader030/viewer/2022041207/5d605b0888c993b3248b7a44/html5/thumbnails/19.jpg)