Transformaciones Espaciales PDF
Transformaciones Espaciales PDF
Transformaciones Espaciales PDF
Descripciones y
Transformaciones
Espaciales
INDICE ....................................................................................................................... 33
2
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Lista de Ejemplos
VECTOR . ........................................................................................................................... 19
EJERCICIO 7 DETERMINE EL EJE (K) Y ÁNGULO DE ROTACIÓN ( ) EQUIVALENTES PARA LA
MATRIZ ............................................................................................................................. 22
EJERCICIO 8 DESARROLLE LAS TRADUCCIONES ENTRE TRANSFORMADA HOMOGÉNEA Y
ÁNGULOS DE EULER (CONVENCIONES X, Y, Y RPY, TRANSFORMADAS HOMOGÉNEAS Y
CUATERNIOS, Y SUS CORRESPONDIENTES TRANSFORMACIONES INVERSAS ..................... 27
4
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Lista de Figuras
FIGURA 1 POSICIÓN Y ORIENTACIÓN DE UN CUERPO RÍGIDO ...................................................... 7
FIGURA 2 ROTACIONES BÁSICAS RESPECTO DE LOS EJES X, Y, Z .............................................. 10
FIGURA 3 MATRIZ DE ROTACIÓN BÁSICA, RX,α, ........................................................................ 12
FIGURA 4 SÓLIDO TRIANGULAR REFERIDO EN EJERCICIO 5...................................................... 15
FIGURA 5 ROTACIÓN RESPECTO DE UN EJE ARBITRARIO R ........................................................... 17
FIGURA 6 RANGOS DE LA FUNCIÓN ATAN2 ( ⎡⎣ −π , π ) )........................................................... 20
FIGURA 7 REPRESENTACIÓN GRÁFICA DE LOS ÁNGULOS DE EULER (CONVENCIÓN X) ............. 23
FIGURA 8 TRANSFORMACIÓN DE PERSPECTIVA ........................................................................ 28
1 Se entiende, idealmente, como cuerpo rígido aquel que no se deforma. En términos más
formales, es una colección de partículas organizadas de tal manera que la distancia entre éstas
permanece fija, independiente de los movimientos o fuerzas ejercidas sobre el conjunto.
2 Los elementos de la teoría de tornillo se remontan al trabajo de Chasles y Poinsot a
6
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
⎡r ⎤
⎢ x⎥
r = ⎢r y ⎥ . (0.1)
⎢ ⎥
⎢⎣ rz ⎥⎦
v 1 ⋅ v 2 = cos ( a ) (0.3)
8
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
wpx wp y wpz
px = , py = , pz = . (0.7)
w w w
T
Ejercicio 1 Dado un vector u = ⎡⎣ x y z w ⎤⎦ cual es el vector k transformado en translación
T
por un vector ⎡a i bj c k ⎤⎦ ?
⎣
z z
cubo p
unitario wy
w w
p
wz
vy v
o v y vz y
o α
u
α Plano y-z
x
z z
cubo
w unitario wx
p
p φ
wz
o v y x
uz o
u φ
ux
Plano x-z
x
z
cubo
θ unitario
w
p vy v
vx
o v y o y
ux
u θ
uy u
x x
10
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
siendo Q = R −1 = R T .
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
w
v
⎡ i ⋅i ix ⋅ jv i x ⋅ kw ⎤
kz · kw α kz· jv =senα ⎢ x u ⎥
=cosα y R = ⎢ j y ⋅ iu j y ⋅ jv j y ⋅ kw ⎥ , (0.11)
jy · kw =- jy · jv =cosα ⎢ ⎥
⎢⎣ kz ⋅ i u kz ⋅ j v kz ⋅ kw ⎥⎦
senα
x=u y utilizando las identidades relacionadas con la naturaleza periódica del seno
y el coseno para simplificar el valor angular,
(
sen (θ ) = −sen ( −θ ) = − cos θ + 90o = cos θ − 90o ) ( ) (0.12)
(
cos (θ ) = cos ( −θ ) = sen θ + 90 = −sen θ − 90 o
) ( o
)
se puede entonces derivar las matrices de rotación con respecto a cada eje
rotado, de la siguiente manera: P xyz = R x, α P uvw , donde Rx,α corresponde
a una rotación respecto del eje x en un ángulo α . En este caso se observa
que i x ≡ i u ya que no cambian después de la rotación (ver Figura 3).
⎡ i ⋅i ix ⋅ jv i x ⋅ kw ⎤ ⎡1 0 0 ⎤
⎢ x u ⎥ ⎢ ⎥
R x ,α = ⎢ j y ⋅ iu j y ⋅ jv j y ⋅ kw ⎥ = ⎢0 cos (α ) −sen (α ) ⎥ . (0.13)
⎢ ⎥
⎢⎣ kz ⋅ i u kz ⋅ j v kz ⋅ kw ⎥⎦ ⎢⎣0 sen (α ) cos (α ) ⎥⎦
Igualmente,
⎡ i ⋅i ix ⋅ jv i x ⋅ kw ⎤ ⎡ cos (φ ) 0 sen (φ ) ⎤
⎢ x u ⎥ ⎢ ⎥
R y ,φ = ⎢ j y ⋅ iu j y ⋅ jv j y ⋅ kw ⎥ = ⎢ 0 1 0 ⎥, (0.14)
kz ⋅ kw ⎥⎦ ⎣ −sen (φ ) 0 cos (φ ) ⎦
⎢ ⎥ ⎢ ⎥
⎢⎣ kz ⋅ i u kz ⋅ j v
⎡ i ⋅i ix ⋅ jv i x ⋅ kw ⎤ ⎡cos (θ ) −sen (θ ) 0 ⎤
⎢ x u ⎥ ⎢ ⎥
Rz ,θ = ⎢ j y ⋅ iu j y ⋅ jv j y ⋅ kw ⎥ = ⎢ sen (θ ) cos (θ ) 0 ⎥ . (0.15)
⎢ ⎥ ⎢
⎢⎣ kz ⋅ i u kz ⋅ j v kz ⋅ kw ⎥⎦ ⎣ 0 0 1 ⎥⎦
12
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Estas son las matrices de rotaciones básicas. Pueden ser multiplicadas entre
si para representar una secuencia de rotación finita respecto al sistema de
referencia; pero como la multiplicación de matrices no conmuta es
importante el orden de realización de las rotaciones.
T
Suponiendo un punto poxyz = ⎡⎣1 2 3 ⎤⎦ expresado con respecto del
sistema OXYZ y asumiendo que el sistema de coordenadas OUVW ha sido
rotado con respecto del eje X un ángulo de 30º, el mismo punto expresado
en términos del sistema de coordenadas OUVW estaría dado por:
1 0 0 1
p ouvw . .
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
Ejercicio 2 Dado un punto u = 3i + 4 j + 5k cual es el efecto de rotarlo 90o alrededor del eje z
hasta un nuevo punto v ?
Ejercicio 3 Rote el punto v anterior alrededor del eje y α hasta un nuevo punto w. Defina la rotación
compuesta, de manera simbólica, en T.
14
z
{-1,0,2,1}
cos ( φ) 0 sen ( φ)
R yv ( φ) 0 1 0
sen ( φ) 0 cos ( φ)
cos ( θ ) sen ( θ ) 0
R zw( θ ) sen ( θ ) cos ( θ ) 0
0 0 1
Ejercicio 4 Aplique una transformación de rotación sobre el resultado anterior, T, de sobre su propio eje z,
para definir simbólicamente Tn.
Ejercicio 5 Suponga un objeto sólido de forma triangular con vértices indicados en la Figura 5. Defina la
transformación compuesta que represente una rotación de 90o sobre el eje z seguida de una rotación de
90o sobre el eje y seguida de una translación de 3 unidades en la dirección x. Encuentre los vértices
resultantes del objeto transformado.
16
z
rz
❺
1.1.3.
❷ Rotación Sobre un Eje Arbitrario
r
❹
β algunos casos se hace necesario representar giros del sistema de
En
coordenadas en movimiento OUVW sobre ejes arbitrarios. Por ejemplo,
rx suponiendo rquey
se quiere mover la mano de un robot manipulador sobre
un eje arbitrario dentro de su volumen de trabajo (espacio de trabajo
alcanzable por el manipulador) con el propósito de insertar una tuerca en
x un tornillo. Se define ely eje de giro de rosca del tornillo como el eje
arbitrario y se representa este por medio de un vector unitario con
(
componentes r = rx , r y , rz ) que pasa por el mismo origen del sistema de
coordenadas de la mano del robot.
rx r 2 − rx2 r y2 + rz2
sen ( β ) = cos ( β ) = =
rx2 + r y2 + rz2 rx2 + r y2 + rz2 rx2 + r y2 + rz2
R r ,φ = R x ,−α ⋅ R y ,β ⋅ Rz ,θ ⋅ R y ,− β ⋅ R x ,α
⎢ y(
⎡ cφ r 2 + r 2 + r 2
z x ) rx r y r V φ − sφ r rz
2
rx rz r V φ + sφ r r y ⎤
2
⎥
⎢ r
2
r
3
r
3
⎥
⎢ ⎥
R r ,φ
⎢ r r r V φ + sφ r 2 r
=⎢
x y z (
cφ rx2 + rz2 + r y2 ) r y rz r V φ − sφ r rx ⎥
2
⎥
⎢ r
3
r
2
r
3
⎥
⎢ ⎥
⎢ r r r V φ − sφ r 2 r
⎢ xz y
r y rz r V φ + sφ r rx
2
( 2 2
)
cφ rx + r y + rz ⎥
2
⎥
⎢ r
3
r
3
r
2
⎥
⎣ ⎦
() ()
donde, cφ = cos φ , sφ = sen φ , V φ = 1 − cos (φ ) y el vector r no
requiere ser expresado como vector unitario.
⎡ r 2V φ + r 2 c φ rx r yV φ − sφ r rz rx rzV φ + sφ r r y ⎤
⎢ x ⎥
1 ⎢
r y rzV φ − sφ r rx ⎥
2
R r ,φ = 2 rx r yV φ + sφ r rz r y2V φ + r c φ (0.16)
r ⎢⎢ ⎥
rz V φ + r c φ ⎥⎥
2
⎢⎣rx rzV φ − sφ r r y r y rzV φ + sφ r rx 2
⎦
Donde
18
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
fin Ejemplo 3
La ecuación (0.16) representa una transformación muy útil que será utilizada
posteriormente.
Ejercicio 6 Suponiendo que el efector final de un manipulador debe atornillar una tuerca sobre un eje
T
definido por el vector r = ⎡⎣1 2 3 ⎤⎦ . Encontrar la matriz de rotación, R r ,α , que representa la
rotación en θ respecto del vector .
⎡n ox ax ⎤
⎢ x ⎥
R = ⎢n y oy ay⎥
⎢ ⎥
⎢⎣ nz oz a z ⎥⎦
⎡n o a ⎤ ⎡ r 2V φ + r 2 c φ r r V φ − sφ r r r r V φ + sφ r r ⎤
⎥ 1 ⎢⎢ ⎥
x x y z x z y
⎢ x x x
r y V φ + r c φ r y rzV φ − sφ r rx ⎥
2
⎢n y o y a y ⎥ = 2 ⎢rx r yV φ + sφ r rz
2
⎢ ⎥ r ⎢ (0.17) ⎥
n o a rz V φ + r c φ ⎥⎥
2
⎢⎣ z z z ⎥
⎦ ⎢⎣rx rzV φ − sφ r r y r y rzV φ + sφ r rx
2
⎛
( ) (o − a ) + (a ) + (n ) ⎞⎟⎠ .
2 2 2
φ = atan2 ⎜ n x + o y + a z − 1 , − nz − ox (0.18)
⎝ z y x y
n x + o y + az − 1
cφ = (0.19)
2
1
(o − a ) + (a ) + (n )
2 2 2
sφ = z y x
− nz y
− ox (0.20)
2
oz − a y
rx = (0.21)
2sen (φ )
a x − nz
ry = (0.22)
2sen (φ )
n y − ox
rz = (0.23)
2sen (φ )
20
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
n x − cos (φ )
(
rx = signo oz − a y ) 1 − cos (φ )
(0.24)
o y − cos (φ )
(
r y = signo a x − nz ) 1 − cos (φ )
(0.25)
a z − cos (φ )
(
rz = signo n y − ox ) 1 − cos (φ )
(0.26)
Si rx es el más grande,
n y + ox
ry = (0.27)
2rxV φ
a x + nz
rz = (0.28)
2rxV φ
Si r y es el más grande,
n y + ox
rx = (0.29)
2r yV φ
oz + a y
rz = (0.30)
2r yV φ
Si rz es el más grande,
a x + nz
rx = (0.31)
2rzV φ
oz + a y
ry = (0.32)
2rzV φ
Ejemplo 4 Determinación del eje y ángulo de rotación equivalentes a partir de una matriz de rotación dada.
⎡0 0 1 ⎤
⎢ ⎥
R y ,90 Rz ,90 = ⎢1 0 0 ⎥
⎢⎣0 1 0 ⎥⎦
⎛ 3 ⎞
θ = atan2 ⎜⎜ 2 ⎟ = 120o
-1 ⎟
⎜⎝ 2 ⎟⎠
1/ 2
kx = = 1
3/ 2 3
Entonces,
1
ky =
3
1
kz =
3
1 1 1
Es decir, R y ,90o Rz ,90o = R k,120o donde k = i+ j+ k
3 3 3
fin Ejemplo 4
⎡ 0 −1 0 0 ⎤
⎢ ⎥
0 0 1 0⎥
Rz ,90 R y ,90 =⎢
⎢ −1 0 0 0 ⎥
⎢ ⎥
⎣ 0 0 0 1⎦
22
z,z1
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
y1
y
φ
x 1.1.4.
x1 Operadores de Rotación con Ángulos de Euler y Cuaternios
z,z1
y2
z2
θ
y
φ
x x 1,
X2
z,z1 y3
z2,z3 y2
θ
y
ψ
φ x3
x
x1,x2
Existen múltiples secuencias de rotación posibles con estos tres ángulos, sin
embargo, en la práctica se utilizan con mayor frecuencia las convenciones
RPY (“Roll-Pitch-Yaw”), X y Y (para la cuales la rotación intermedia se da
sobre el eje respectivo mencionado). A continuación se presentan las
matrices correspondientes a dichas convenciones,
⎡ c φ cθ cφ sθ sψ − sφcψ cφ sθ cψ + sφ sψ ⎤
⎢ ⎥
Rz ,φ R y ,θ R x ,ψ = ⎢ sφ c θ sφ sθ sψ + cφcψ sφ sθ cψ − cφ sψ ⎥ (0.33)
⎢⎣ −sθ cθ sψ cθ cψ ⎥⎦
1.1.5. Cuaternios
Q = ( q 0 , q1 , q 2 , q 3 ) = ( s ,v ) (0.36)
24
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Q ⋅ Q* = ( )
q 02 + q12 + q 22 + q 32 h (0.41)
⎛ ⎛θ⎞ ⎛θ ⎞⎞
Q = R ( r , θ ) = ⎜ cos ⎜ ⎟ , r ⋅sen ⎜ ⎟ ⎟ (0.43)
⎝ ⎝ 2⎠ ⎝ 2⎠⎠
El cuaternio que representa una rotación de 900 sobre un eje ( 4, 2, −1) está
dada por,
⎛ 2 4 2 2 2 − 2⎞
(
Q = R r , 900 = ⎜
⎝ 2
,)2
,
2
, ⎟
2 ⎠
fin Ejemplo 5
Q3 = Q2 ⋅ Q1 (0.44)
(0, r ) = Q ⋅ (0, r
oxyz ouvw
+ p) ⋅ Q* (0.46)
fin Ejemplo 6
θ φ −ψ
q 0 = sen cos (0.49)
2 2
θ φ −ψ
q1 = sen sen (0.50)
2 2
θ φ +ψ
q 2 = cos sen (0.51)
2 2
θ φ +ψ
q 3 = cos cos (0.52)
2 2
∑q 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 i≠ j (0.55)
Donde i=0,1,2.
En forma matricial,
26
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
⎡q x2 − q 2y − qz2 + q 32 2q x q y + 2q 3qz 2q x qz − 2q 3q y ⎤
⎢ ⎥
R = ⎢ 2q x q y − 2q 3qz −q x2 + q 2y − qz2 + q 32 2q y qz + 2q 3q x ⎥ (0.56)
⎢ ⎥
⎢⎣ 2q x qz + 2q 3q y 2q y qz − 2q 3q x −q x2 − q 2y + qz2 + q 32 ⎥⎦
Ejercicio 8 Desarrolle las traducciones entre Transformada Homogénea y Ángulos de Euler (convenciones
X, Y, y RPY, Transformadas Homogéneas y Cuaternios, y sus correspondientes transformaciones inversas
Falta Enunciado ¡!
f
y
x’,y’,z’ coordenadas homogéneas desde un sistema de coordenadas hasta otro
sistema de coordenadas. Consisten de 4 submatrices.
x
⎡ Rotacion 3x 3 Posicion 3x 1 ⎤
T =⎢ ⎥ (0.57)
⎣ perspectiva1x 3 escalado1x 1 ⎦
Un rayo que pase por el centro del lente no se desvía, por lo tanto, se puede
escribir,
z z'
= (0.58)
y y'
x x'
= (0.59)
y y'
Un rayo pasante y paralelo al lente pasa a través del punto focal f, por lo
tanto,
z z'
= (0.60)
f y '+ f
28
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
x x'
= (0.61)
f y '+ f
Nótese que x’, y’, y z’ son negativos y f es positivo. Eliminando y’ entre las
ecuaciones (0.58) y (0.60) se obtiene,
z z'
= (0.62)
f ⎛z' y ⎞
⎜⎝ z + f⎟
⎠
z
z'= (0.63)
1− y f
x
x'= (0.64)
1− y f
z y
= (0.65)
z' y'
z f
= (0.66)
z ' y '+ f
Por lo tanto,
y f
= (0.67)
y ' y '+ f
y
y'= (0.68)
1− y f
⎡1 0 0 0⎤
⎢ ⎥
⎢0 1 0 0⎥
P = ⎢0 0 1 0⎥ (0.69)
⎢ ⎥
⎢0 − 1 0 1⎥
⎢⎣ f ⎥⎦
⎡ x ⎤ ⎡1 0 0 0⎤
⎢ ⎥ ⎢ ⎥ ⎡x ⎤
⎢ y ⎥ ⎢0 1 0 0⎥ ⎢ ⎥
y
⎢ z ⎥ = ⎢0 0 1 0⎥ ⎢ ⎥ (0.70)
⎢ ⎥ ⎢ ⎥ ⎢z ⎥
⎢1 − y ⎥ ⎢0 − 1 ⎢ ⎥
0 1⎥ ⎣ 1 ⎦
⎢⎣ f ⎥⎦ ⎢⎣ f ⎥⎦
⎡a 0 0 0⎤
⎢ ⎥
0 b 0 0⎥
T =⎢ (0.72)
⎢0 0 c 0⎥
⎢ ⎥
⎣0 0 0 1⎦
30
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Referencias
1. B. Roth, “Performance Evaluation of Manipulators from a Kinematic
Viewpoint”, Performance Evaluation of Manipulators, National Bureau
of Standards, special publication, 1975.
11. S. Y., Nof, ”Handbook of Industrial Robotics”, 2nd Ed., John Wiley &
Sons, New York, 1999.
13. K.S. Fu, R.C. González y C.S.G. Lee, “Robótica: Control, Detección,
Visión e Inteligencia”, McGraw-Hill, España, 1988.
32
DESCRIPCIONES Y TRANSFORMACIONES ESPACIALES
Indice
A S
atan2, 20 sistema de coordenadas, 6, 7, 8, 9, 10, 11, 13,
14, 17, 23, 28
C
T
cosenos de dirección, 8
Transformaciones Espaciales
Ángulos de Euler, 23
L Cuaternios, 23, 24, 25, 26
localización, 6 Conjugado de, 24
Inverso de, 25
Norma de, 25
M Producto de, 24
Producto por un escalar, 24
matriz de rotación, 8 Suma de, 24
Escalado, 30
O Matrices de rotación básica, 10
matriz de transformación homogénea, 27
ortogonales, 6, 19 Perspectiva, 28
Rotación, 10, 13, 14, 17, 18, 19, 23, 27
R
relación espacial, 6, 7
V
Robot Stanford, 31 vector, 6, 7, 8, 9, 11, 13, 17, 18, 19, 21, 24, 25,
Rotaciones Compuestas, 13 26, 27
vector de posición, 7