Advanced
Intelligent Robotics
Tomáš Pajdla
2005
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 1
pajdla@cmp.felk.cvut.cz
V předmětu IRO 2005 se naučíme,
jak lze vyřešit inverzní kinematickou úlohu pro obecný
manipulátor se šesti stupni volnosti.
Obecné řešení tohoto problému existuje
Vedlejší efekt …
… metoda řešení soustav algebraických rovnic
pajdla@cmp.felk.cvut.cz
Industrial Robotic Applications
pajdla@cmp.felk.cvut.cz
Precision for industry
Low (e.g. manipulation)
5 mm in the whole working space
0.5 mm locally
… often available
High (e.g. laser welding)
0.5 mm in the whole working space
0.05 mm locally
… often not available
pajdla@cmp.felk.cvut.cz
Error 0.5 mm
pajdla@cmp.felk.cvut.cz
Precision for robotic surgery
http://www.cts.usc.edu/rsi-article-robotputsuscatforefront.html
pajdla@cmp.felk.cvut.cz
Stäubli TX-90
pajdla@cmp.felk.cvut.cz
Kinematic model
flange frame
z y
x
z
x y
world frame
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
The Standard Kinematic model in Denavit-Hartenberg Convention
Stäubli TX 90
TX-90 (6 axis, RRRRRR) [Staubli]
a d
-1.5708 50.0 0.0 350.0
0.0 425.0 0.0 50.0
-1.5708 0.0 0.0 0.0
1.5708 0.0 0.0 425.0
-1.5708 0.0 0.0 0.0
0.0 0.0 0.0 100.0
6 non-trivial parameteres
pajdla@cmp.felk.cvut.cz
The Standard Kinematic model in Denavit-Hartenberg Convention
ABB IBR 140
pajdla@cmp.felk.cvut.cz
The Standard Kinematic model in Denavit-Hartenberg Convention
ABB IBR 140
IBR-140 (6 axis) [ABB]
a d
-1.5708 70.0 0.0 352.0
0.0 360.0 0.0 0.0
-1.5708 0.0 0.0 0.0
1.5708 0.0 0.0 380.0
-1.5708 0.0 0.0 0.0
0.0 0.0 0.0 65.0
5 non-trivial parameteres
pajdla@cmp.felk.cvut.cz
The Standard Kinematic model in Denavit-Hartenberg Convention
Stäubli TX 90
RV-6S (6 axis, RRRRRR) [Mitsubishi]
a d
-1.5708 85.0 0.0 350.0
0.0 280.0 0.0 0.0
-1.5708 100.0 0.0 0.0
1.5708 0.0 0.0 315.0
-1.5708 0.0 0.0 0.0
0.0 0.0 0.0 85.0
6 non-trivial parameteres
pajdla@cmp.felk.cvut.cz
Special versus General Mechanisms
Special General
simple & tractable complicated & hard
a d a d
-1.5708 70.0 - 352.0 -1.42 70.1 - (+0.2) 352.0
0.0 360.0 - 0.0 0.10 360.0 - (+0.1) 0.2
-1.5708 0.0 - 0.0 -1.57 0.2 - (- 0.3) 0.3
1.5708 0.0 - 380.0 1.58 0.1 - (+0.1) 380.2
-1.5708 0.0 - 0.0 -1.59 0.4 - (- 0.1) 0.1
0.0 0.0 - 65.0 0.07 0.2 - (- 0.2) 65.1
6 non-trivial parameters 18 (+6) non-trivial parameters
High precision Small misalignments important General mechanisms
pajdla@cmp.felk.cvut.cz
Literature
Linear algebra
P. Pták. Introduction to Linear Algebra. Vydavatelství ČVUT, Praha,1997.
Numerical linear algebra
E. Krajník. Maticový počet. Vydavatelství ČVUT, Praha, 2000.
The solution
M. Raghavan, B. Roth. Kinematic Analysis of the 6R Manipulator of General
Geometry. Int. Symp. Robotics. Research. Pp. 314-320, Tokyo 1989/1990.
The numerical solution
D. Manocha, J. Canny. Efficient Inverse Kinematics for General 6R
Manipulators. Robotics and Automation 1994.
The pedagogical solution will be developed using
D. Cox, J. Little, D. O'Shea. Ideals, Varieties, and Algorithms. Springer 1998.
pajdla@cmp.felk.cvut.cz
Software
Matlab: www.matworks.com
Maple: www.maple.com
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 2
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
rotation
reflection
translation
z-compression
pajdla@cmp.felk.cvut.cz
motion
pajdla@cmp.felk.cvut.cz
motion
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 3
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 4
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
R. S. Hartenberg and J. Denavit, “A kinematic notation for lower pair mechanisms based
on matrices,” Journal of Applied Mechanics, vol. 77, pp. 215–221, June 1955.
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
R. S. Hartenberg and J. Denavit, “A kinematic notation for lower pair mechanisms based
on matrices,” Journal of Applied Mechanics, vol. 77, pp. 215–221, June 1955.
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
R. S. Hartenberg and J. Denavit, “A kinematic notation for lower pair mechanisms based
on matrices,” Journal of Applied Mechanics, vol. 77, pp. 215–221, June 1955.
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
R. S. Hartenberg and J. Denavit, “A kinematic notation for lower pair mechanisms based
on matrices,” Journal of Applied Mechanics, vol. 77, pp. 215–221, June 1955.
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
R. S. Hartenberg and J. Denavit, “A kinematic notation for lower pair mechanisms based
on matrices,” Journal of Applied Mechanics, vol. 77, pp. 215–221, June 1955.
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Transformation in a joint is described by 4 parameters
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
RV-6S/6SC
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
MATLAB simulation in ROBOT toolbox:
mRV6S =
RV-6S (6 axis, RRRRRR) [Mitsubishi] <home = [0.000000 -1.047198 -0.523599 0.000000 0.785398 0.000000]>
grav = [0.00 0.00 9.81]
alpha_i a_i theta_i d_i R/P standard D&H parameters
-1.570796 85.000 parameter 350.000 R (std)
0.000000 280.000 parameter 0.000 R (std)
-1.570796 100.000 parameter 0.000 R (std)
1.570796 0.000 parameter 315.000 R (std)
-1.570796 0.000 parameter 0.000 R (std)
0.000000 0.000 parameter 85.000 R (std)
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 5
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 6
pajdla@cmp.felk.cvut.cz
monomial
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 7
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 8
pajdla@cmp.felk.cvut.cz
Solving Algebraic Equations by Groebner Bases in Maple
Click to start
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 9
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz
Advanced Robotics
Lecture 10
pajdla@cmp.felk.cvut.cz
pajdla@cmp.felk.cvut.cz