Posicion y Orientacion
Posicion y Orientacion
Posicion y Orientacion
Figura 1
Pz = Pz’
1
En forma matricial:
Pz 0 0 1 Pz’
𝑅" (𝛼 )
𝑅" (𝛼 ) es conocida como matriz de rotación (en este caso es un ángulo α con
respecto a z) y sus componentes son conocidos como cosenos direccionales.
𝐶𝑜𝑠 β 0 𝑆𝑒𝑛 β
𝑅' (β) = * 0 1 0 4
−𝑆𝑒𝑛 β 0 𝐶𝑜𝑠 β
1 0 0
𝑅5 (𝛾) = * 0 𝐶𝑜𝑠 𝛾 −𝑆𝑒𝑛 𝛾 4
0 𝑆𝑒𝑛 𝛾 𝐶𝑜𝑠 𝛾
RT R = I
2
Demostración utilizando 𝑅" (𝛼 ); se puede utilizar también 𝑅' (β) o 𝑅5 (𝛾).
𝐶𝑜𝑠 𝛼 −𝑆𝑒𝑛 𝛼 0
𝑅" (𝛼 ) = * 𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
𝑅 8 𝑅𝑅 <= = 𝐼𝑅 <=
𝑅 8 = 𝑅 <=
Demostración de RT=R-1 usando 𝑅" (𝛼 ) (se puede utilizar también 𝑅' (β) o
𝑅5 (𝛾) )
𝐶𝑜𝑠 𝛼 −𝑆𝑒𝑛 𝛼 0
( )
𝑅" 𝛼 = * 𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
Matriz de cofactores:
𝐶𝑜𝑠 𝛼 −𝑆𝑒𝑛 𝛼 0
𝐶𝑜𝑓?𝑅" (𝛼 )@ = * 𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
3
Transpuesta de la matriz de cofactores
8
𝐶𝑜𝑠 𝛼 𝑆𝑒𝑛 𝛼 0
R𝐶𝑜𝑓?𝑅" (𝛼 )@S = * −𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
8 𝐶𝑜𝑠 𝛼 𝑆𝑒𝑛 𝛼 0
<=
R𝐶𝑜𝑓?𝑅" (𝛼 )@S
𝑅" (𝛼) = = * −𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
𝐷𝑒𝑡?𝑅" (𝛼 )@ 0 0 1
Para comprobar, trasponemos 𝑅" (𝛼 ) y comparamos contra 𝑅" (𝛼)<=
𝐶𝑜𝑠 𝛼 𝑆𝑒𝑛 𝛼 0
𝑅78 (𝛼 ) = * −𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
Se comprueba que
Por otro lado, se considerará que |R| = 1 si la rotación es contra las manecillas
del reloj (right-handed) y |R| = -1 cuando la rotación es a favor de las manecillas
del reloj (left-handed). Por lo general se usarán marcos del tipo right-handed
(que cumplan con la regla de la mano derecha).
Las matrices de rotación 𝑅" (𝛼 ), 𝑅' (β) o 𝑅5 (𝛾) ) tienen también la siguiente
propiedad:
donde k = x, y, z
y Ω = α, β, γ
4
Demostración numérica utilizando un ángulo de giro de 30 grados con respecto
al eje z.
𝐶𝑜𝑠 𝛼 −𝑆𝑒𝑛 𝛼 0
𝑅" (𝛼 ) = * 𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
0.867 0.5 0
𝑅" (−30) = * −0.5 0.867 0 4
0 0 1
𝐶𝑜𝑠 𝛼 𝑆𝑒𝑛 𝛼 0
𝑅78 (𝛼 ) = * −𝑆𝑒𝑛 𝛼 𝐶𝑜𝑠 𝛼 0 4
0 0 1
0.867 0.5 0
𝑅78 (30) = * −0.5 0.867 0 4
0 0 1
5
Composición de Matrices de Rotación
Y0
Y1
P
Y2 X2
p0
X1
X0
O
Z0, Z1, Z2
Figura 2
Sean 𝑂_𝑥a 𝑦a 𝑧a, 𝑂_𝑥= 𝑦= 𝑧=, 𝑂_𝑥9 𝑦9 𝑧9 tres diferentes marcos de referencia con
un origen común 𝑂.
𝑝a = 𝑅=a 𝑝= (1)
𝑝= = 𝑅9=𝑝9 (2)
𝑝a = 𝑅9a 𝑝9 (3)
6
Sustituyendo la ecuación (2) en la ecuación (1):
𝑝a = 𝑅=a𝑅9=𝑝9
7
Traslación y Rotación: Transformaciones homogéneas
𝑂=a
Figura 3
𝑂=a es el vector que describe el origen del marco 1 (𝑂_𝑥= 𝑦= 𝑧=) con respecto al
marco cero 𝑂_𝑥a 𝑦a 𝑧a (traslación).
8
La transformación inversa puede ser obtenida despejando 𝑝= de la ecuación (5)
𝑅=a𝑝= = 𝑝a − 𝑂=a
𝑝= = (𝑅=a)<=𝑝a − (𝑅=a)<=𝑂=a
𝑅=a 𝑂=a
donde 𝐴=a = r s (8)
08 1
es llamada “Matriz de Transformación Homogénea”.
En forma compacta:
𝑝̅ a = 𝐴=a𝑝̅ = (9)
9
O bien 𝑝̅ = = 𝐴=a 𝑝̅ a (10)
𝑝̅ = = (𝐴=a)<=𝑝̅ a (11)
𝑝̅ = = 𝐴=a𝑝̅ a = (𝐴=a)<=𝑝̅ a
1 0 0 𝑑1
0 1 0 𝑑2
𝐴=| •
0 0 1 𝑑3
0 0 0 1
donde d1, d2 y d3 son las traslaciones que se tengan en los ejes x, y, z
respectivamente. La parte de rotación produce una matriz identidad debido a
que el ángulo (𝛼 ó β ó γ) es cero.
10
En suma, una matriz de transformación homogénea expresa la transformación
de coordenadas entre dos marcos de referencia en una forma compacta.
𝑝̅ 0 = 𝐴=a𝐴=9 … 𝐴i<=
i 𝑝̅
n
𝑝̅ 0 = 𝐴ai 𝑝̅ n
11