kinematics analysis of robots (part 3). this lecture continues the discussion on the analysis of the...
TRANSCRIPT
![Page 1: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/1.jpg)
KINEMATICS ANALYSIS
OF ROBOTS(Part 3)
![Page 2: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/2.jpg)
This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots.
After this lecture, the student should be able to:•Solve problems of robot kinematics analysis using transformation matrices
Kinematics Analysis of Robots III
![Page 3: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/3.jpg)
Example: A 3 DOF RRR Robot
Link and Joint Assignment
Link (2) Link (3)Link (1)
Revolute joint <1>
Link (0)
Revolute joint <2>
Revolute joint <3>
![Page 4: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/4.jpg)
Example: A 3 DOF RRR Robot
Frame Assignment
Z1
Z1
Y1
Y1
X1
![Page 5: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/5.jpg)
Example: A 3 DOF RRR Robot
Frame Assignment
Y0, Y1
X0, X1
Z0, Z1
Z2
Z2
X2
Y2
Y2
![Page 6: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/6.jpg)
Example: A 3 DOF RRR Robot
Frame Assignment
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
Z3
X3
Y3
Y3
![Page 7: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/7.jpg)
Example: A 3 DOF RRR Robot
Frame Assignment
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
X3
Y3
1
2 3
![Page 8: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/8.jpg)
Example: A 3 DOF RRR Robot
Tabulation of D-H parameters
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
X3
Y3
A B
0 = (angle from Z0 to Z1 measured along X0) = 0°a0 = (distance from Z0 to Z1 measured along X0) = 0d1 = (distance from X0 to X1 measured along Z1)= 01 = variable (angle from X0 to X1 measured along Z1)1 = 0° (at home position) but 1 can change as the arm moves
![Page 9: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/9.jpg)
Example: A 3 DOF RRR Robot
Tabulation of D-H parameters
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
X3
Y3
A B
1 = (angle from Z1 to Z2 measured along X1) = 90°a1 = (distance from Z1 to Z2 measured along X1) = Ad2 = (distance from X1 to X2 measured along Z2) = 02 = variable (angle from X1 to X2 measured along Z2)2 = 0° (at home position) but 2 can change as the arm moves
![Page 10: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/10.jpg)
Example: A 3 DOF RRR Robot
Tabulation of D-H parameters
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
X3
Y3
A B
2 = (angle from Z2 to Z3 measured along X2) = 0°a2 = (distance from Z2 to Z3measured along X2) = Bd3 = (distance from X2 to X3 measured along Z3) = 03 = variable (angle from X2 to X3 measured along Z3)3= 0° (at home position) but 3 can change as the arm moves
![Page 11: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/11.jpg)
Link i Twist i Link length ai
Link offset di
Joint angle i
i=0 0 0 … …
i=1 90° A 0 1
(1=0° at home position)
i=2 0 B 0 2
(2=-0° at home position)
i=3 … … 0 3
(3=-0° at home position)
Summary of D-H parameters
![Page 12: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/12.jpg)
Example: A 3 DOF RRR Robot
Tabulation of Transformation Matrices from the D-H table
1000
)cos()cos()cos()sin()sin()sin(
)sin()sin()cos()cos()sin()cos(
0)sin()cos(
1111
1111
1
1
iiiiiii
iiiiiii
iii
ii d
d
a
T
1000
0100
00)cos()sin(
00)sin()cos(
11
11
01
T
0,0,0 100 da
![Page 13: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/13.jpg)
Example: A 3 DOF RRR Robot
Tabulation of Transformation Matrices from the D-H table
0,,90 211 dAa
1000
00)cos()sin(
0100
0)sin()cos(
22
22
12
A
T
1000
)cos()cos()cos()sin()sin()sin(
)sin()sin()cos()cos()sin()cos(
0)sin()cos(
1111
1111
1
1
iiiiiii
iiiiiii
iii
ii d
d
a
T
![Page 14: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/14.jpg)
Example: A 3 DOF RRR Robot
Tabulation of Transformation Matrices from the D-H table
0,,0 322 dBa
1000
0100
00)cos()sin(
0)sin()cos(
33
33
23
B
T
1000
)cos()cos()cos()sin()sin()sin(
)sin()sin()cos()cos()sin()cos(
0)sin()cos(
1111
1111
1
1
iiiiiii
iiiiiii
iii
ii d
d
a
T
![Page 15: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/15.jpg)
Example: A 3 DOF RRR Robot
Forward Kinematics
1000
00)cos()sin(
)sin()cos()sin()sin()cos()sin(
)cos()sin()sin()cos()cos()cos(
22
112121
112121
12
01
02
A
A
TTT
1000
)sin(0)cos()sin(
)sin())cos(()cos()sin()sin()cos()sin(
)cos())cos(()sin()sin()cos()cos()cos(
23232
121321321
121321321
2
3
0
2
0
3
B
BA
BA
TTT
![Page 16: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/16.jpg)
Y0, Y1
X0, X1
Z0, Z1
Z2
X2
Y2
Z3
X3
Y3
A=3 B=2 C=1
P
Example: A 3 DOF RRR Robot
What is the position of point “P” at the home position?
Solution:
1
0
0
1
1
3 p
11
303
0 pT
p
![Page 17: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/17.jpg)
Example: A 3 DOF RRR Robot
1
0
0
1
1000
)sin(0)cos()sin(
)sin())cos(()cos()sin()sin()cos()sin(
)cos())cos(()sin()sin()cos()cos()cos(
123232
121321321
121321321
3
0
3
B
BA
BA
pT
1= 2= 3=0, A=3, and B=2:
1
0
0
6
1
0
0
1
1000
0010
0100
5001
11
303
0 pT
p
![Page 18: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/18.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics
Given the orientation and position of point “P”:
TTTTpaon
paon
paon
zzzz
yyyy
xxxx
03
23
12
01
1000
1
0
0
1
1000
)sin(0)cos()sin(
)sin())cos(()cos()sin()sin()cos()sin(
)cos())cos(()sin()sin()cos()cos()cos(
123232
121321321
121321321
3
0
3
B
BA
BA
pT
![Page 19: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/19.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics
Equate elements (1,3) and (2,3):
y
x
y
x
a
aa
a1
11
1tan
)cos(
)sin(
Provided that 1)( 22 yx aa
Equate elements (1,4) and (2,4):
Ap
BBAp
Ap
BBAp
yy
xx
)cos(1
)sin()sin())cos((
)cos(1
)cos()cos())cos((
1212
1212
![Page 20: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/20.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics
If cos(1)0, then use px to find cos(2). Afterwards, find
Otherwise use py to find sin(2) and then solve using
)cos()sin(
tan
)(cos1)sin(
2
212
22
2
)cos()sin(
tan
)(sin1)cos(
2
212
22
2
![Page 21: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/21.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics
Equate elements (3,1) and (3,2):
z
z
z
z
on
o
n 132
32
32 tan)()cos(
)sin(
2323
Now find 1, 2, and 3 given the orientation and position of point “P”:
1000
1001
0100
5010
1000zzzz
yyyy
xxxx
paon
paon
paon
![Page 22: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/22.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics
0tan1
01
1
y
x
y
x
a
aa
a
Now cos(1)=10. We use px to find cos(2):
1)cos(
1)cos(
2,3,5
12
Ap
B
BAp
x
x
0)cos()sin(
tan
0)(cos1)sin(
2
212
22
2
![Page 23: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/23.jpg)
Example: A 3 DOF RRR Robot
Inverse Kinematics90tan)(
0
1 132
z
z
z
z
on
o
n
900902323
Y0
X0
Z0
Z3
X3
Y3
1000
1001
0100
5010
1000zzzz
yyyy
xxxx
paon
paon
paon A=3 B=2
PC=1
![Page 24: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/24.jpg)
Forward & Inverse Kinematics Issues
Given a set of joint variables, the forward kinematics will always produce an unique solution giving the robot global position and orientation. On the other hand, there may be no solution to the inverse kinematics problem. The reasons include:•The given global position of the arm may be beyond the robot work space•The given global orientation of the gripper may not be possible given that the gripper frame must be a right hand frame
For the inverse kinematics problem, there may also exist multiple solutions, i.e. the solution may not be unique.
![Page 25: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/25.jpg)
Forward & Inverse Kinematics Issues
Example of multiple solutions given the same gripper global position and orientation:
First solution
Second solution
First solution
Second solution
Some solutions may not be feasible due to obstacles in the workspace
![Page 26: KINEMATICS ANALYSIS OF ROBOTS (Part 3). This lecture continues the discussion on the analysis of the forward and inverse kinematics of robots. After this](https://reader036.vdocuments.us/reader036/viewer/2022062421/56649e2a5503460f94b17b12/html5/thumbnails/26.jpg)
Summary
This lecture continues the the discussion on the analysis of the forward and inverse kinematics of robots.
The following were covered:•Problems of robot kinematics analysis using transformation matrices