Download - Direct Kinematics
![Page 1: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/1.jpg)
Direct Kinematics
![Page 2: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/2.jpg)
Link Description
![Page 3: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/3.jpg)
The concept of Direct Kinematics
• Choosing wisely the coordinate systems on the links
• If the wise choice was made, each link can be represented with 4 parameters
• When the parameters are found, the transformation matrices between the links can be found from a closed formula
![Page 4: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/4.jpg)
DK Algorithm
• 1) Draw sketch• 2) Identify and number robot links. Base = 0, Last = n• 3) Draw axis Zi for joint i. For rotating joint, Zi is the
rotation axis. For prismatic (translating) joint, Zi can merge with the DOF axis or be perpendicular to it.
• 5) Determine joint length ai-1 between Zi-1 and Zi
• 6) Draw axis Xi-1 along the shortest distance between Zi-1 and Zi. If the distance is 0, choose the direction of Xi-1 to be a normal to the plane that they create.
![Page 5: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/5.jpg)
DK Algorithm (2)
• 7) Determine joint twist i-1 measured around Xi-1 (between Zi-1 and Zi)
• 8) Determine the joint offset di
• 9) Determine joint angle i around Zi
• 10) Write DH table• 11+12) Write link transformations and calculate
the common transformation
![Page 6: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/6.jpg)
Kinematics Parameters of a link
1i
Link length
Link twist
1ia
![Page 7: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/7.jpg)
What are the kinematics parameters of this link?
• a = 7 = 450
![Page 8: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/8.jpg)
Kinematics Parameters of a link
• Link offset d• Joint angle
![Page 9: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/9.jpg)
Summary of the link parameters in terms of link frames
• ai = the distance from Zi to Zi+1 measured along Xi i = the angle between Zi and Zi+1 measured about Xi• di = the distance from Xi-1 to Xi measured along Zi i = the angle between Xi-1 and Xi measured about Zi
• We usually choose ai > 0 since it corresponds to a distance;
• However, i , di , i are signed quantities.
![Page 10: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/10.jpg)
There is no unique attachment of frames to links:
• 1. When we align Zi axis with joint axis i, two choices of the Zi direction.
• 2. When we have intersecting joint axes (ai=0), two choices of the Xi direction, corresponding to choice of signs for the normal to the plane containing Zi and Zi+1.
• 3. When axes i and i+1 are parallel, the choice of origin location for {i} is arbitrary (generally chosen in order to cause di to be zero).
![Page 11: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/11.jpg)
PTTTTPTP iPi
QP
RQ
iR
iii
i 111
![Page 12: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/12.jpg)
TTTTT Ri
PR
RQ
iR
ii
11
iZiZiXiXi
i dDRaDRT 111
iiZiiXi
i dScrewaScrewT ,, 111
1000
)cos()cos()sin()cos()sin()sin(
)sin()sin()cos()cos()cos()sin(
0)sin()cos(
1111
1111
1
1
iiiiiii
iiiiiii
iii
ii d
d
a
T
![Page 13: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/13.jpg)
Three link Arm : RPR mechanism
• “Cylindrical” robot – 2 joints analogous to polar coordinates when viewed from above.
• Schematic: point – axes intersection; prismatic joint at minimal extension
• Find coordinate systems and a, , d, (i=3)
![Page 14: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/14.jpg)
i ai i di i
0 0 0
1 0 90 0 1
2 0 0 d2 0
3 L2 3
DH table:
![Page 15: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/15.jpg)
1000
0100
00)cos()sin(
00)sin()cos(
11
11
01
T
![Page 16: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/16.jpg)
1000
0010
100
0001
212
dT
![Page 17: Direct Kinematics](https://reader030.vdocument.in/reader030/viewer/2022013103/56812c37550346895d90bde8/html5/thumbnails/17.jpg)
1000
100
00)cos()sin(
00)sin()cos(
2
33
33
23 LT
TTTTT NNN12
312
01
0 ...