Académique Documents
Professionnel Documents
Culture Documents
ngulo (orientacin).
La rotacin total puede expresarse como:
A
B
A
B'
(3.65)
De donde:
A
B
R zyx
( , , ) = Rot (
B
B
, )
Rot (
B'
B'
, )
Rot (
B' '
B' '
, )
(3.66)
Por consiguiente,
A
B
R zyx
C s 0
( , , ) = [ s C 0 ]
0
0 1
C 0 s
[ 0 1 0 ]
s 0 C
1 0
0
0 C s
[
]
0 s C
(3.67)
A
B
R zyx
(,
,
(3.68)
C C C s s s C C s C + s s
[ s C s s s +C C s s C C s
s
C s
C C
A
B
R zyz
69)
C s c s s C c s s C C s
(, , ) = [ s c c +C s s c s +C C s s
s C
s s
C
(3-
r 32
, -
r 31
);
= arctg2(
2
31
2
+r 32
, r 33 ;
= arctg2(
r 23
r 31
(3.70)
Suponiendo sen 0.
El ngulo se elige de forma que 0 180, que corresponde a la raz positiva.
De igual manera forma que se ha visto anteriormente, si = 0 o = 180 la solucin es
degenerada. En este caso solo puede calcularse la suma a la diferencia de y .
Eligiendo = 0 se obtienen las soluciones:
0,
0,
arctg2(
r 12
r 11
arctg2(
r 12
r 11
(3.71
0,
180,
(3.72)
en la herramienta MATLAB del apndice, los ngulos de Euler Z-Y-Z se obtienen a partir
de una transformada homognea (T) dada, empleando la funcin: [alpha beta gamma] =
tr2eul (T).
Pares de rotacin y cuaternios
Por ltimo, conviene mencionar otras representaciones posibles de la orientacin tales
como los denominadores pares de rotacin a los cuaternios.
ngulos RPY
Se emplean los ngulos RPY: roll (balanceo), pitch (inclinacin), y yaw (orientacin)
que, en terminologa nutica, corresponden respectivamente a alabeo, cabeceo y guiada.
Supngase que se desea expresar la orientacin de un objeto, que tiene una sistema de ejes
asociados {B}, con respecto a un sistema de referencia {A}. se comienza con {B}
coincidente con la referencia {A} y se efecta una rotacin de {B} alrededor de
angulo (balanceo). A continuacin se efecta una rotacin alrededor de
(inclinacin) y finalmente una rotacin alrededor de
la figura 3.18 (Craig, 1986) se ilustra el procedimiento.
un
un angulo
un angulo (orientacin). En
R RPY
( , , ) = Rot (
A , ) Rot (
A , ) Rot (
A , ).
(3.54)
Que puede expresarse como producto de matrices de rotacin
A
B
R RPY
C s 0
C 0 s
( , , ) = [ s C 0 ] [ 0 1 0 ]
s 0 C
0
0 1
1 0
0
0 C s
[
]
0 s C
(3.55)
Efectuando la multiplicacin de matrices se obtiene:
A
B
R RPY
C C C s s s C C s C + s s
( , , ) = [ s C s s s +C C s s C C s
s
C s
C C
(3.56)
En la herramienta MATLAB del apndice existe una funcin que permite obtener la
transformacin homognea a partir de los ngulos RPY. Para utilizarla basta escribir:
T = rpy2tr (gamma, beta, alpha)
El problema inverso tambin tiene inters. Se trata ahora de obtener los ngulos de
orientacin conocida la matriz de rotacin}
A
B
r 11 r 12 r 13
= [ r 21 r 22 r 23
r 31 r 32 r 33
(3.57)
Para obtener las tres incgnitas pueden plantearse nueve ecuaciones de las cuales seis son
dependientes. En la prctica, basta plantear tres ecuaciones con tres incgnitas. Por
ejemplo, suponiendo
r 32
a partir
r 33
r 32
r 33
= arctg2(
r 32
r 33
r 33
(3.58)
As, por ejemplo,
= arctg2(-2,-2) = -135
(3.59)
Mientras que
arctg2(2,2) = 45
(3.60)
= arctg2(- r 31 ,
2 2
11 21
(3.61)
Escogiendo la solucin -90 90, que corresponde a tomar la raz como positiva.
Finalmente, puede aplicarse la misma funcin para obtener
= arctg2(
(3.62)
r 21
r 11
= 0,
= 90,
= -90,
= arctg2(
r 12
r 22
= 0). En estos
(3.63)
= 0,
= arctg2(
r 12
r 22
(3.64)
en la herramienta MATLAB del apndice, para obtener los ngulos RPY a partir de una
transformada homognea dada (T) basta escribir:
[r p y] = tr2rpy (T)
Bibliografia
Craig J.J., 1986. Introduction to Robotic. Mechanics and Control. Addison Wesley.
Anibal Ollero Baturone., 2009. Robotica Manipuladores y robots mviles.Alfaomega
Grupo Editor.