Documente Academic
Documente Profesional
Documente Cultură
MOVIMIENTO DE
CUERPOS RIGIDOS
(segunda parte)
1
Contenido
1. Composicin de rotaciones.
2. Parametrizacin de rotaciones
ngulos de Euler.
ngulos Roll, Pitch, Yaw
Representacin Eje-Angulo
Cuaternin unitario
1. COMPOSICIN DE ROTACIONES
Se refiere al anlisis de
la rotacin que resulta
al aplicar una serie de
rotaciones.
Composicin respecto al eje actual
R10 R21
R R R
0
2
0
1
1
2
Solucin.
R Ry ,f Rz ,q
cos f 0 sin f cos q sin q 0 Demo_01.m
0 1 0 sin q cos q 0
sin f 0 cos f 0 0 1
cos f cos q cos f sin q sin f
sin q cos q 0
sin f cos q sin f sin q cos f
Si se aplica un orden invertido se obtiene el mismo resultado?
Composicin respecto al eje actual
1.5
q pi / 4 1 Z
Z21 0
0.5
Y
2
0 {1}
X0 {2}
{0} Y 10
-0.5
X1 X
2
-1
-1.5
-2
-2
-1 -2
0 -1
1 1 0
2 2
Composicin respecto al eje inercial
R10
R
R RR
0
2
0
1
Solucin.
R Rz ,q Ry ,f
cos q sin q 0 cos f 0 sin f Demo_03.m
sin q cos q 0 0 1 0
0 0 1 sin f 0 cos f
cos q cos f sin q cos q sinf
sin q cos f cos q sin q sinf
sin f 0 cos f
Si se aplica un orden invertido se obtiene el mismo resultado?
Composicin respecto al eje inercial
Z0
1 Z1 Z
2
{1}
{2}
{0}
Y2
0 X Y 10
0
X1 X2
-1
-2
-2 -1
-2
-1 0
0 1
1
2 2
Composicin respecto al eje inercial
Demostracin.
R R
1
2 1
0 1
RR10 Aplicando la transformacin de similitud
De donde se aplicando la ley de composicin en el eje actual.
R R R1 RR10 RR10
0 0 1
0
2
1
De donde se tiene que las matrices de rotaciones sucesivas en el eje
inercial se acumulan por la izquierda pre-multiplication.
Composicin de rotaciones
Ejercicio. Se tienen los sistemas coordenados {1}, {2} y {3} que cumplen las
siguientes relaciones
Halle la matriz
Composicin de rotaciones
Rpta.
FUNCION atan2
R R I3
T
R r21 r22 r23
r
31 r33
En las secciones siguientes, a partir
de R se busca una representacin
r32
mnima.
2.1 ngulos de Euler
Sistema Gimball
ngulos de Euler
RZYZ Rz ,f Ry ,q Rz ,y
cf sf 0 cq 0 sq cy sy 0 Demo_05.m
sf cf 0 0 1 0 sy cy 0
0 0 1 sq 0 cq 0 0 1
cf cq cy sf sy cf cq sy sf cy cf sq
sf cq cy cf sy sf cq sy cf cy sf sq
sq cy s s c get_matrix_euler.m
q y q
ngulos de Euler
f pi / 6 2
1.5 Z0
q pi / 4 1 Ze Ye
y pi / 6
0.5 {0}
{e} Y0
X
0 0
Xe
-0.5
-1
-2
-1.5 -1
0
-2
-2 1
-1.5 -1 -0.5 0 0.5 1 2
1.5 2
Demo_06.m
ngulos de Euler
Lo que sigue es hallar los ngulos de Euler para una matriz de rotacin R
(esto se usa mas adelante en el problema de la cinemtica inversa).
cf cq cy sf sy cf cq sy sf cy cf sq
1 caso : r33 1
RZYZ sf cq cy cf sy sf cq sy cf cy sf sq
sq cy sq sy cq
cq r33 , sq 1 r332 0
Hay dos soluciones dependiendo del signo elegido para q
sq 0
q (0, )
= atan2 r33 , 1- r 2
33 f = atan2(r13 ,r23 )
y = atan2(-r31 ,r32 )
sq 0
q ( ,0)
= atan2 r33 ,- 1- r 2
33 f = atan2(-r13 ,-r23 )
y = atan2(r31 ,-r32 )
ngulos de Euler
atan2(x, y)
r11 r12 0
2 caso : r33 1
RZYZ r21 r22 0
0 1
0
Si r33 1 q 0
c cy s sy c sy s cy 0 cf y sf y 0
RZYZ s cy c sy s sy c cy 0 sf y cf y 0
0 0 1 0 0 1
r11 r12 0
2 caso : r33 1 RZYZ r21 r22 0
0 1
Si r33 1 q 0
cf y sf y 0 r11 r12 0
RZYZ sf y cf y 0 r21 r22 0
0 0 1 0 0 1
De donde: f -y = atan2 -r11 ,-r12
Ya que hay infinitas soluciones usualmente se asume por convencin: f 0
Cual es el significado fsico en de este caso? get_euler_angles.m
ngulos de Euler
Demo_07.m
2.2. ngulos Roll-Pitch-Yaw
R XYZ Rz,f Ry ,q R x ,y
cf sf 0 cq 0 sq 1 0 0
sf cf 0 0
1 0 0 cy sy
0 0 1 sq 0 cq 0 sy cy
cf cq sf cy cf sq sy sf sy cf sq cy
sf cq cf cy sf sq sy cf sy sf sq cy
sq cq sy cq cy
Los ngulos pueden hallarse usando un mtodo similar al usado en los
ngulos de Euler
ngulos Roll, Pitch, Yaw
f pi / 6 1.5
Z
0
q pi / 4
1
Ze
0.5
Y
e
y pi / 6
{e}
{0} Y0
0 X0
-0.5 Xe
-1
-1.5
-2
-2 0
-2 -1 0 1 2 2
Demo_08.m
ngulos Roll, Pitch, Yaw
Lo que sigue es hallar los ngulos RPY para una matriz de rotacin R (esto se
usa mas adelante en el problema de la cinemtica inversa).
r sq c s c c
31 r32 r33 q y q y
c cq s cy c sq sy s sy c sq cy
1 caso : r31| 1 RXYZ s cq c cy s sq sy c sy s sq cy
sq cq sy cq cy
sq r31 , cq 1 r312 r322 r332 0
Hay dos soluciones dependiendo del signo elegido para q
cq 0
q ( / 2, / 2)
= atan2 -r31 , 1- r 2
31 f = atan2(r21 ,r11 )
y = atan2(r32 ,r33 )
sq 0
q ( / 2,3 / 2)
= atan2 -r31 ,- 1- r 2
31 f = atan2(-r21 ,-r11 )
y = atan2(-r32 ,-r33 )
ngulos Roll, Pitch, Yaw
Demo_09.m
2.3. Representacin Eje/Angulo
k x
k k y
k z
2.3. Representacin Eje/Angulo
De la figura se tiene: R Rz , Ry ,
0
1
Y aplicando similitud
2.3. Representacin Eje/Angulo
De donde se tiene:
Tr R 1
Para una matriz de rotacin q cos 1
R se puede demostrar que: 2
r11 r12 r13 r32 r23
1
R r21 r22 r23 k r r
2 sinq
13 31
r r33
31 r32 r21 r12
get_axis_angle_from_R.m
2.3 Representacin Eje/Angulo
Donde
Parte escalar
Parte vectorial
Bajo la siguiente condicin
2.4. Cuaternin unitario
De donde se tiene: