Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Descripciones y
Transformaciones
Espaciales
Tabla de Contenido
2.
1.1.4.
1.1.5.
1.1.5.1.
Lista de Ejemplos
EJEMPLO 1
EJEMPLO 2
EJEMPLO 3
EJEMPLO 4
Lista de Ejercicios
EJERCICIO 1 DADO UN VECTOR u = x
UN VECTOR
a i
bj
y z
c k ? ............................................................................................ 9
90o
90o
SOBRE EL EJE Y
r = 1 2 3 . ENCONTRAR LA
MATRIZ DE ROTACIN, R r , , QUE REPRESENTA LA ROTACIN EN RESPECTO DEL
UNA TUERCA SOBRE UN EJE DEFINIDO POR EL VECTOR
VECTOR . ........................................................................................................................... 19
EJERCICIO 7 DETERMINE EL EJE (K) Y NGULO DE ROTACIN ( ) EQUIVALENTES PARA LA
MATRIZ ............................................................................................................................. 22
EJERCICIO 8 DESARROLLE LAS TRADUCCIONES ENTRE TRANSFORMADA HOMOGNEA Y
NGULOS DE EULER (CONVENCIONES X, Y, Y RPY, TRANSFORMADAS HOMOGNEAS Y
CUATERNIOS, Y SUS CORRESPONDIENTES TRANSFORMACIONES INVERSAS ..................... 27
Lista de Figuras
FIGURA 1
FIGURA 2
FIGURA 3
FIGURA 4
FIGURA 5
r
x
r = r y .
rz
(0.1)
Oxuw
ROxyz
x '
x
= x ' y
x 'z
y 'x
y'y
y 'z
z 'x
z 'y .
z 'z
(0.2)
v 1 v 2 = cos ( a )
(0.3)
Oxyz
x ' x
= x ' y
x 'z
y ' x z ' x
y ' y z ' y
y 'z z 'z
(0.4)
ROxyz =
Oxyz
(0.5)
(0.6)
px =
wp y
wpz
wpx
, py =
, pz =
.
w
w
w
(0.7)
a i
bj
u = x
y z
c k ?
z
cubo
unitario
wy
p
v
vz
vy
wz
Plano y-z
x
z
z
cubo
unitario
wz
uz
wx
ux
Plano x-z
x
z
w
cubo
unitario
p
vy
vx
ux
uy
pxyz = Rpuvw
(0.8)
puvw = Qpxyz
(0.9)
Como
los
productos
escalares
son
conmutativos,
T
1
QR = R R = R R = U 33 (donde U es una matriz de identidad de 3x3),
siendo Q = R 1 = R T .
Definicin de los componentes de un vector :
puvw = pu i u + pv iv + pw kw
(0.10)
px = i x p = i x i u pu + i x j v pv + i x kw pw
p y = j y p = j y i u pu + j y j v pv + j y kw pw
pz = kz p = kz i u pu + kz j v pv + kz kw pw
Por propiedad, el producto escalar es conmutativo, es decir a b = b a , por
lo tanto reescribiendo las ecuaciones anteriores de forma matricial
Andrs Jaramillo Botero, 2005
11
w
kz kw
=cos
jy kw =sen
x=u
kz jv =sen
jy jv =cos
i i
x u
R
=
j y iu
y
kz i u
i x kw
j y kw ,
kz kw
ix jv
j y jv
kz j v
(0.11)
(0.12)
se puede entonces derivar las matrices de rotacin con respecto a cada eje
rotado, de la siguiente manera: P xyz = R x, P uvw , donde Rx, corresponde
a una rotacin respecto del eje x en un ngulo . En este caso se observa
que i x i u ya que no cambian despus de la rotacin (ver Figura 3).
R x ,
i i
x u
= j y iu
kz i u
ix jv
j y jv
kz j v
i x kw 1
0
0
j y kw = 0 cos ( ) sen ( ) .
kz kw 0 sen ( ) cos ( )
(0.13)
i x kw cos ( ) 0 sen ( )
j y kw = 0
1
0 ,
kz kw sen ( ) 0 cos ( )
(0.14)
i x kw cos ( ) sen ( ) 0
j y kw = sen ( ) cos ( ) 0 .
0
1
kz kw 0
(0.15)
Igualmente,
R y ,
Rz ,
i i
x u
= j y iu
kz i u
i i
x u
= j y iu
kz i u
ix jv
j y jv
kz j v
ix jv
j y jv
kz j v
12
0
1
.
.
.
0 cos( 30 grd ) sen( 30 grd ) 2
0 sen( 30 .grd ) cos( 30 .grd )
3
1
p ouvw = 3.232
1.598
fin Ejemplo 1
13
2.
3.
2.
3.
4.
14
z
{-1,0,2,1}
{1,0,2,1}
{1,0,0,1}
Plano x-y
x
{-1,0,0,1}
{-1,4,0,1}
{1,4,0,1}
y
1
R xu ( )
0 cos ( )
sen ( )
0 sen ( ) cos ( )
cos ( ) 0 sen ( )
R yv ( )
sen ( ) 0 cos ( )
cos ( )
R zw( )
sen ( ) 0
sen ( ) cos ( ) 0
0
0.361
0.554 0.538
0.117
0.806
0.51
0.824
0.247
Ejercicio 4 Aplique una transformacin de rotacin sobre el resultado anterior, T, de sobre su propio eje z,
para definir simblicamente Tn.
Ejercicio 5 Suponga un objeto slido de forma triangular con vrtices indicados en la Figura 5. Defina la
transformacin compuesta que represente una rotacin de
90o sobre el eje y seguida de una translacin de 3 unidades en la direccin x. Encuentre los vrtices
resultantes del objeto transformado.
15
fin Ejemplo 2
16
rz
1.1.3.
Rotacin Sobre un Eje Arbitrario
r
En
algunos casos se hace necesario representar giros del sistema de
coordenadas en movimiento OUVW sobre ejes arbitrarios. Por ejemplo,
se quiere mover la mano de un robot manipulador sobre
rx suponiendo rque
y
un eje arbitrario dentro de su volumen de trabajo (espacio de trabajo
alcanzable por el manipulador) con el propsito de insertar una tuerca en
y eje de giro de rosca del tornillo como el eje
un tornillo. Se define el
arbitrario y se representa este por medio de un vector unitario con
componentes r = rx , r y , rz
( u , v , w ) , ( rx, ry , rz)
17
sen ( ) =
sen ( ) =
ry
rz
cos ( ) =
r y2 + rz2
rx
rx2 + r y2 + rz2
r y2 + rz2
r 2 rx2
cos ( ) =
rx2 + r y2 + rz2
r y2 + rz2
rx2 + r y2 + rz2
R r , = R x , R y , Rz , R y , R x ,
La matriz de rotacin compuesta resultante puede expresarse en trminos
del vector r as,
R r ,
c r 2 + r 2 + r 2
y
z
x
r r r V + s r 2 r
x y
z
=
3
r r r V s r 2 r
y
xz
3
rx r y r V s r rz
c rx2 + rz2 + r y2
r
2
2
r y rz r V + s r rx
r
()
rx rz r V + s r r y
2
r y rz r V s r rx
2
2
2
c rx + r y + rz
()
R r ,
r 2V + r 2 c
x
1
= 2 rx r yV + s r rz
r
rx rzV s r r y
rx r yV s r rz
2
r y2V + r c
r y rzV + s r rx
rx rzV + s r r y
r y rzV s r rx
2
2
rz V + r c
(0.16)
Donde
Ejemplo 3 Rotacin sobre un eje arbitrario
0.271 0.391
R x( 35 .grd , r ) = 0.391
0.879
0.271
0.271 0.391
0.879
fin Ejemplo 3
La ecuacin (0.16) representa una transformacin muy til que ser utilizada
posteriormente.
Ejercicio 6 Suponiendo que el efector final de un manipulador debe atornillar una tuerca sobre un eje
definido por el vector
rotacin en
n
x
R = n y
nz
ox
oy
oz
ax
ay
a z
r 2V + r 2 c r r V s r r r r V + s r r
n o a
x
x y
z
x z
y
x
x x
1
2
2
r y V + r c r y rzV s r rx
n y o y a y = 2 rx r yV + s r rz
(0.17)
r
2
2
n
o
a
z
z
z
rz V + r c
rx rzV s r r y r y rzV + s r rx
De este procedimiento, y asumiendo una rotacin positiva alrededor del
vector r de tal forma que 0 , se encuentra que el ngulo de rotacin
est definido de manera nica como:
) (o a ) + (a
= atan2 n x + o y + a z 1 ,
19
nz
) + (n
2
ox
) .
2
(0.18)
c =
s =
1
2
n x + o y + az 1
(o a ) + (a
2
(0.19)
nz
) + (n
2
ox
(0.20)
rx =
ry =
rz =
oz a y
2sen ( )
a x nz
2sen ( )
n y ox
2sen ( )
(0.21)
(0.22)
(0.23)
20
rx = signo oz a y
r y = signo a x nz
rz = signo n y ox
n x cos ( )
1 cos ( )
o y cos ( )
1 cos ( )
a z cos ( )
1 cos ( )
(0.24)
(0.25)
(0.26)
Si rx es el ms grande,
ry =
rz =
n y + ox
2rxV
a x + nz
2rxV
(0.27)
(0.28)
Si r y es el ms grande,
rx =
rz =
n y + ox
2r yV
oz + a y
2r yV
(0.29)
(0.30)
Si rz es el ms grande,
rx =
ry =
a x + nz
2rzV
oz + a y
2rzV
(0.31)
(0.32)
Ejemplo 4 Determinacin del eje y ngulo de rotacin equivalentes a partir de una matriz de rotacin dada.
21
R y ,90 Rz ,90
0 0 1
= 1 0 0
0 1 0
3
2 = 120o
= atan2
-1
2
Siendo > 90o se determina el componente ms grande de k
correspondiente al elemento ms grande de la diagonal.
kx =
1/ 2
= 1
3/ 2
3
Entonces,
ky =
kz =
1
3
1
3
1
3
i+
1
3
j+
1
3
fin Ejemplo 4
Rz ,90 R y ,90
0 1 0 0
0 0 1 0
=
1 0 0 0
0 0 0 1
22
z,z1
1.1.4.
x1 Operadores de Rotacin con ngulos de Euler y Cuaternios
z,z1
z2
y2
z2,z3
x 1,
X2
z,z1 y3
y2
y
x3
x1,x2
Rz , R y , R x ,
c c
= s c
s
c s s sc
s s s + cc
c s
23
c s c + s s
s s c c s
c c
(0.33)
Rz , R x ', Rz ',
cc sc s
= sc + cc s
s s
sc c c s
cc c s s
s c
s s
c s
c
(0.34)
Rz , R y ', Rz ',
s s cc c
= c s + sc c
s c
cc s sc
sc s + cc
s s
c s
s s
c
(0.35)
1.1.5. Cuaternios
Uno de los problemas en el uso de los ngulos de Euler es que conducen a
singularidades cuando el movimiento angular se acerca a 00 o a 1800. Sin
embargo, empleando cuaternios y lgebra de cuaternios es factible evitar
dichas singularidades. Los cuaternios, definidos por Hamilton [HAM1843],
pueden ser empleados para representar transformaciones de giros y
orientaciones. Un cuaternio est constituido por cuatro componentes
variables ( q 0 , q1 , q 2 , q 3 ) que representan sus coordenadas en una base
{h, i , j , k} .
Q = ( q 0 , q1 , q 2 , q 3 ) = ( s ,v )
(0.36)
Q3 = Q1 Q2 = ( s 1 ,v 1 ) ( s 2 ,v 2 ) = s 1s 2 v 1T v 2 ,v 1 v 2 + s 1v 2 + s 2v 1
(0.38)
Q3 = Q1 + Q2 = ( s 1 ,v 1 ) + ( s 2 ,v 2 ) = ( s 1 + s 2 ,v 1 + v 2 )
(0.39)
Q2 = aQ1 = a ( s 1 ,v 1 ) = ( as 1 , av 1 )
24
(0.40)
Q Q* =
q 02 + q12 + q 22 + q 32 h
(0.41)
Q*
Q
Q 1 =
(0.42)
Q = R ( r , ) = cos , r sen
2
2
(0.43)
2 4 2 2 2 2
Q = R r , 900 =
,
,
,
2
2
2
2
Q3 = Q2 Q1
(0.44)
oxyz
ouvw
25
(0.45)
(0, r ) = Q (0, r
oxyz
+ p) Q*
ouvw
(0.46)
oxyz
+ p Q*
(0.47)
oxyz
oxyz
(0.48)
fin Ejemplo 6
q 0 = sen cos
2
2
(0.49)
q1 = sen sen
2
2
(0.50)
+
q 2 = cos sen
2
2
(0.51)
+
q 3 = cos cos
2
2
(0.52)
2
n
=1
(0.53)
n=0
R ii = q 32 + q i2 q 2j
(0.54)
j i
R ij = 2q i q j + ijk q 3q k
Donde i=0,1,2.
En forma matricial,
26
i j
(0.55)
R = 2q x q y 2q 3qz
2q x qz + 2q 3q y
2q x q y + 2q 3qz
q x2 + q 2y qz2 + q 32
2q y qz 2q 3q x
2q y qz + 2q 3q x
q x2 q 2y + qz2 + q 32
2q x qz 2q 3q y
(0.56)
Ejercicio 8 Desarrolle las traducciones entre Transformada Homognea y ngulos de Euler (convenciones
X, Y, y RPY, Transformadas Homogneas y Cuaternios, y sus correspondientes transformaciones inversas
FALTA INCLUIR TRANSFORMACIONES EQUIVALENTES!!
27
z
x,y,z
f
x,y,z
x
y
coordenadas homogneas desde un sistema de coordenadas hasta otro
sistema de coordenadas. Consisten de 4 submatrices.
Rotacion 3x 3
T =
perspectiva1x 3
Posicion 3x 1
escalado1x 1
(0.57)
z z'
=
y y'
(0.58)
x x'
=
y y'
(0.59)
Un rayo pasante y paralelo al lente pasa a travs del punto focal f, por lo
tanto,
z
z'
=
f
y '+ f
28
(0.60)
(0.61)
z
z'
=
f z' y
z +
(0.62)
z'=
z
1 y f
(0.63)
x'=
x
1 y f
(0.64)
z
y
=
z' y'
(0.65)
z
f
=
z ' y '+ f
(0.66)
y
f
=
y ' y '+ f
(0.67)
y
1 y f
(0.68)
Por lo tanto,
y'=
1 0
0 1
P = 0 0
0 1
f
Andrs Jaramillo Botero, 2005
29
0 0
0 0
1 0
0 1
(0.69)
se transforma de la siguiente
manera,
x 1 0
y 0 1
z = 0 0
1 y 0 1
f
f
0 0
x
0 0
y
1 0
z
0 1 1
(0.70)
x
y
z
i+
j+
k
(1 y / f ) (1 y / f ) (1 y / f )
(0.71)
0
T =
0
0
b
0
0
0
0
c
0
0
0
(0.72)
30
Referencias
1. B. Roth, Performance Evaluation of Manipulators from a Kinematic
Viewpoint, Performance Evaluation of Manipulators, National Bureau
of Standards, special publication, 1975.
2. D. Pieper, The Kinematics of Manipulators Under Computer
Control Unpublished Ph.D. thesis, Stanford University, 1968.
3. H.Y., Lee y C.G., Liang, Displacement Analysis of the General Spatial
7-Link 7R Mechanism. Mechanism and Machine Theory, 23, 219-226,
1998.
4. R.G., Selfridge, Analysis of 6-Link Revolute Arms, Mechanism and
Machine Theory, 24 (1), 1-8, 1989.
5. C., Mavroidis, y B., Roth, Structural Parameters Which Reduce the
Number of Manipulator Configurations, Journal of Mechanical
Design, 116, 3-10, 1994.
6. J., Duffy, Analysis of Mechanisms and Manipulators, John Wiley &
Sons, 1980.
7. M., Raghavan y B., Roth, Inverse kinematics of Manipulators Under
Computer Control, Proceedings 2nd International Congress for the
Theory of Machines and Mechanisms, Zakopane, Poland. Vol. 2. 159168. 1993.
8. R.P., Paul, Robot Manipulators: Mathematics, Programming and
Control, MIT Press, 1981.
9. D.E. Whitney, Resolved Motion Rate Control of Manipulators and
Human Prosthesis, IEEE Transactions on Man-Machine Systems,
10(2), 47-53, 1969.
10. R.M. Murray, Z. Li, y S.S. Sastry, A Mathematical Introduction to
Robotic Manipulation, London: CRC Press, 1994.
11. S. Y., Nof, Handbook of Industrial Robotics, 2nd Ed., John Wiley &
Sons, New York, 1999.
12. R.C. Dorf, S. Y., Nof, International Encyclopedia of Robotics:
Applications and Automation, Vol. 1-3, John Wiley & Sons, New
York, 1988.
13. K.S. Fu, R.C. Gonzlez y C.S.G. Lee, Robtica: Control, Deteccin,
Visin e Inteligencia, McGraw-Hill, Espaa, 1988.
14. Barrientos, L.F. Pein, C. Balaguer, R. Aracil, Fundamentos de
Robtica, McGraw-Hill, Espaa, 1998.
31
Glosario de Trminos
32
Indice
atan2, 20
cosenos de direccin, 8
Transformaciones Espaciales
ngulos de Euler, 23
Cuaternios, 23, 24, 25, 26
Conjugado de, 24
Inverso de, 25
Norma de, 25
Producto de, 24
Producto por un escalar, 24
Suma de, 24
Escalado, 30
Matrices de rotacin bsica, 10
matriz de transformacin homognea, 27
Perspectiva, 28
Rotacin, 10, 13, 14, 17, 18, 19, 23, 27
L
localizacin, 6
M
matriz de rotacin, 8
O
ortogonales, 6, 19
relacin espacial, 6, 7
Robot Stanford, 31
Rotaciones Compuestas, 13
33