introduction to robotics cpsc - 460
DESCRIPTION
Introduction to Robotics cpsc - 460. Lecture 3A – Forward Kinematics. DH Techniques. A link j can be specified by two parameters, its length aj and its twist α j - PowerPoint PPT PresentationTRANSCRIPT
![Page 1: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/1.jpg)
INTRODUCTION TO ROBOTICSCPSC - 460
Lecture 3A – Forward Kinematics
![Page 2: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/2.jpg)
DH TECHNIQUES
A link j can be specified by two parameters, its length aj and its twist αj
Joints are also described by two parameters. The link offset dj is the distance from one link coordinate frame to the next along the axis of the joint. The joint angle θj is the rotation of one link with respect to the next about the joint axis.
![Page 3: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/3.jpg)
DH TECHNIQUES
•Link twist αi :the angle from the Zi-1 axis to the Zi axis about the Xi axis. The positive sense for α is determined from zi-1 and zi by the right-hand rule.
•Joint angle θi the angle between the Xi-1 and Xi axes about the Zi-1 axis.
![Page 4: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/4.jpg)
DH TECHNIQUES
4
![Page 5: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/5.jpg)
DH TECHNIQUES
The four parameters for each linkai: link length
αi: Link twist
di : Link offset
θi : joint angle
With the ith joint, a joint variable is qi
associated where
5
![Page 6: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/6.jpg)
TRANSFORMATION MATRIX
6
Each homogeneous transformation Ai is represented as a product of four basic transformations
, , , ,i i i ii z z d x a xA Rot Trans Trans Rot
1. Rotation of about current Z axis
2. Translation of d along current Z axis
3. Translation of a along current X axis
4. Rotation of about current X axis
![Page 7: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/7.jpg)
TRANSFORMATION MATRIX
7
i i i i i i i
i i i i i i i
i i i
c -c s s s a c
s c c -s c a s
0 s c d
0 0 0 1
iA
A
1000
00
00
0001
1000
0100
0010
001
1000
100
0010
0001
1000
0100
00
00
ii
ii
i
i
ii
ii
i CS
SC
a
d
CS
SC
A
, , , ,i i i ii z z d x a xA Rot Trans Trans Rot
![Page 8: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/8.jpg)
TRANSFORMATION MATRIX
The matrix Ai is a function of only a single variable, as three of the above four quantities are constant for a given link, while the fourth parameter is the joint variable, depending on whether it is a revolute or prismatic link
i i i i i i i
i i i i i i i
i i i
c -c s s s a c
s c c -s c a s
0 s c d
0 0 0 1
iA
![Page 9: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/9.jpg)
DH NOTATION STEPS
9
![Page 10: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/10.jpg)
DH NOTATION STEPS
10
![Page 11: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/11.jpg)
DH NOTATION STEPS
From , the position and orientation of the tool frame are calculated.
i i i i i i i
i i i i i i i
i i i
c -c s s s a c
s c c -s c a s
0 s c d
0 0 0 1
iA
0nT
![Page 12: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/12.jpg)
TRANSFORMATION MATRIX
11 12 13
21 22 23
31 32 33
0 0 0 1
x
y
z
r r r d
r r r dT
r r r d
![Page 13: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/13.jpg)
EXAMPLE I - TWO LINK PLANAR ARM
13
• Base frame O0
•All Z ‘s are normal to the page
![Page 14: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/14.jpg)
EXAMPLE I - TWO LINK PLANAR ARM
14
Where (θ1 + θ2 ) denoted by θ12
and
![Page 15: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/15.jpg)
EXAMPLE 2
15
![Page 16: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/16.jpg)
FORWARD KINEMATICS OF EXAMPLE 2
16
![Page 17: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/17.jpg)
EXAMPLE 3 - THREE LINK CYLINDRICAL MANIPULATOR
17
![Page 18: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/18.jpg)
EXAMPLE 3 - THREE LINK CYLINDRICAL MANIPULATOR
18
![Page 19: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/19.jpg)
EXAMPLE 3 - THREE LINK CYLINDRICAL MANIPULATOR
19
![Page 20: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/20.jpg)
EXAMPLE 3 - THREE LINK CYLINDRICAL MANIPULATOR
20
![Page 21: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/21.jpg)
EXAMPLE 4 – THE SPHERICAL WRIST
21
![Page 22: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/22.jpg)
EXAMPLE 4 – THE SPHERICAL WRIST
22
![Page 23: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/23.jpg)
EXAMPLE 4 – THE SPHERICAL WRIST
23
![Page 24: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/24.jpg)
EXAMPLE 4 – THE SPHERICAL WRIST
24
![Page 25: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/25.jpg)
EXAMPLE 5 - CYLINDRICAL MANIPULATOR WITH SPHERICAL WRIST
25
derived in Example 2, and
derived in Example 3.
03T
36T
![Page 26: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/26.jpg)
EXAMPLE 5 - CYLINDRICAL MANIPULATOR WITH SPHERICAL WRIST
26
![Page 27: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/27.jpg)
EXAMPLE 5 - CYLINDRICAL MANIPULATOR WITH SPHERICAL WRIST
27
![Page 28: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/28.jpg)
EXAMPLE 5 - CYLINDRICAL MANIPULATOR WITH SPHERICAL WRIST
28
Forward kinematics:
1. The position of the end-effector: (dx ,dy ,dz )
2. The orientation {Roll, Pitch, Yaw }Rotation about X axis{ROLL}
Rotation about fixed Y axis{PITCH}
Rotation about fixed Z axis{YAW}
![Page 29: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/29.jpg)
ROTATION – ROLL, PITCH, YAW
The rotation matrix for the following operations:
X
Y
Z
axis{YAW} Zfixedabout Rotation
}axis{PITCH Y fixedabout Rotation
axis{ROLL} Xabout Rotation
29
CCSCS
CSSSCSCSSCCS
SSCSCSSCSSCC
CS
SCCS
SC
xRotyRotzRotR
0
0
001
C0S-
010
S0C
100
0
0
),(),(),(
![Page 30: Introduction to Robotics cpsc - 460](https://reader035.vdocuments.us/reader035/viewer/2022070404/56813b84550346895da4ad9d/html5/thumbnails/30.jpg)
EXAMPLE 4THE THREE LINKS CYLINDRICAL WITH SPHERICAL WRIST
30
How to calculate
Compare the matrix R
With the rotation part of
, ,and
06T
C C S S C S S C S C S S
R S C C S S C S C S S S C
S C S C C
31S r 32C S r 21S C r
131( )Sin r 1 32( )
rSin
C
1 21sin ( )
r
C
11 12 13
21 22 23
31 32 33
r r r
r r r
r r r