Professional Documents
Culture Documents
REPRESENTACIN DE LA POSICIN EN
COORDENADAS CARTESIANAS
En un plano: Sistema coordenado OXY de referencia, para el cual el punto a se
expresa por las componentes (x, y). A este punto le corresponde un vector p(x,
y).
En el espacio de tres dimensiones: El vector p est definido por las respectivas
componentes cartesianas (x, y, z).
REPRESENTACIN DE LA POSICIN EN
COORDENADAS POLARES Y CILNDRICAS
En un plano: la localizacin de un punto, es decir, el vector p, se expresa como
p (r, ) en coordenadas polares.
En esta representacin, r es la distancia desde el origen O hasta extremo del
vector p; en tanto que es el ngulo formado por el vector p con el eje OX.
En tres dimensiones: el vector p, queda expresado como p (r, , Z) mediante
las coordenadas cilndricas.
REPRESENTACIN DE LA POSICIN EN
COORDENADAS ESFRICAS
En este caso, el vector p posee como coordenadas esfricas (r,, ), en donde
la componente r es la distancia que va desde el origen O hasta el extremo del
vector p; la componente es el ngulo formado por la proyeccin del vector p
sobre el plano OXY con el eje OX; y la componente es el ngulo formado por
el vector p con el eje OZ.
LECCIN 2: REPRESENTACIN DE LA
ORIENTACIN
Cuando necesitamos definir un punto en el espacio, es suficiente a travs de los
datos correspondientes a su posicin. Pero, para el caso de un slido, se precisa
adicionalmente contar con su orientacin respecto a un sistema de referencia.
Para el caso que nos ocupa, es decir, el de un robot, adems de especificar la
posicin de extremo, tambin se requiere indicar su orientacin. Una
orientacin referida al espacio tridimensional, la podemos definir mediante tres
grados de libertad, lo que se traduce como tres componentes linealmente
independientes. La orientacin de un objeto respecto a un sistema de
referencia, se intenta de manera habitual y relativamente cmoda, asignando al
objeto un nuevo sistema, y luego se estudia la relacin espacial que existe entre
estos dos sistemas, cuya versin es la de coordenadas rectangulares.
Casi siempre, esta relacin se presenta mediante la posicin y orientacin del
sistema, asociado al objeto respecto al de referencia. Para poder ejecutar el
anlisis de los diferentes mtodos con los cuales se representan las
orientaciones, se consideran que ambos coinciden en el origen, y que por
consiguiente no se registra cambio de posicin entre ellos.
El sistema de coordenadas que esta fijo en el espacio tridimensional, se
considera que es el sistema de referencia. El otro sistema de coordenadas est
girando con respecto al sistema de referencia.
Fsicamente, podemos considerar que este sistema de coordenadas, es un
sistema de coordenadas ligado al cuerpo. Es decir, se encuentra permanente y
convenientemente unido al cuerpo rgido (por ejemplo, un elemento del brazo
del robot) y se mueve junto con l. Un punto p en el espacio se puede
representar por sus coordenadas con respecto a ambos sistemas de
coordenadas.
Una forma que facilita el anlisis, consiste en considerar al punto en reposo y
fijo con respecto al sistema que representa el giro. De esta manera, el punto p
MATRICES DE ROTACIN
En el espacio del algebra matricial, encontramos el nicho adecuado que
contiene todos los ingredientes esenciales, los cuales hacen posible que
podamos adentrarnos en la tarea de la descripcin de las orientaciones.
Los dos sistemas de referencia arriba mencionados son: OXY y OUV.
El sistema OXY es el de referencia fija, y el sistema OUV es el mvil solidario al
objeto. Los vectores unitarios del sistema OXY son en tanto que los del
sistema OUV son .
La representacin en ambos sistemas del vector p en el plano, se registra de la
siguiente manera:
En donde
R =
En un espacio tridimensional:
Los vectores unitarios del sistema OXY , mientras que los del sistema
OUVW son .
La correspondiente representacin del vector p queda as:
En este caso, tambin se obtiene la equivalencia siguiente:
En donde,
De igual manera, podemos representar la orientacin del sistema OUVW,
cuando el eje OV coincide con el OY,
=
Ahora, se considera la orientacin del sistema OUVW, cuando el eje OW
coincide con el eje OZ, en cuyo caso, la representacin grafica y la
correspondiente matriz, son:
REPRESENTACIN DE LA ORIENTACIN.
COMPOSICIN DE ROTACIONES
Algunos movimientos efectuados por un robot, o algunas de sus piezas, son el
resultado de la aplicacin continua y combinada de varias rotaciones. La
respectiva definicin y manipulacin de las cantidades matemticas asociadas,
se resuelve mediante la operacin llamada composicin de matrices de
rotacin.
Consideremos la situacin siguiente: al sistema OUVW tratado anteriormente
se le aplica una rotacin con ngulo sobre OX, la cual es seguida de una
rotacin de ngulo sobre OY, ms la rotacin de ngulo sobre OZ. La
rotacin resultante global requerida por el movimiento especifico, la podemos
resumir de la manera siguiente:
1. Rotacin sobre OX.
2. Rotacin sobre OY.
3. Rotacin sobre OZ.
Y representarla mediante la expresin:
Las componentes del vector r con respecto al sistema OXYZ, representado en el
sistema OUVW, son:
ROTACIN
Las rotaciones de un vector alrededor de cada uno de los tres ejes en un ngulo
a, se pueden realizar por las transformaciones de rotacin. En trminos
precisos, para entrar en operacin, definimos tres matrices bsicas de rotacin,
las cuales adoptamos de acuerdo a la rotacin elegida por alguno de los tres
ejes coordenados: OX, OY y OZ del sistema de referencia OXYZ.
Alrededor del eje z:
Ahora procedemos a ilustrar la rotacin de un ngulo alrededor del eje OY, al
cual le sigue una traslacin del vector .
Finalmente, presentamos la rotacin de un ngulo alrededor del eje OZ, al
cual le sigue una traslacin del vector .
Ahora se trata de considerar la traslacin del vector al cual le sigue la
rotacin de un ngulo alrededor del eje OY.
Finalmente, a la traslacin del vector le sigue la rotacin de un ngulo
alrededor del eje OZ.
ILUSTRACIN
MATRICES DE ROTACIN BSICAS
INTERPRETACIN: EJEMPLO
1. Giro de un ngulo sobre el eje OZ
2. Giro de un ngulo sobre el eje OY
3. Giro de un ngulo sobre el eje OX
La matriz que representa el giro resultante, la obtenemos mediante la
composicin de las matrices bsicas de rotacin, y resulta ser:
=
Las anteriores ilustraciones, nos impulsa a informar que los ejes sobre los que
recaan las operaciones correspondan al sistema de referencia fijo OXYZ. Esto
no impide la posibilidad de organizar un conjunto de matrices de
transformacin, que activen operaciones dirigidas de manera permanente al
sistema que este movindose. Esto se logra enlazando matrices de manera
inversa.
Cuando se presenta una tarea robtica que impone la aplicacin del recurso de
la composicin de varias transformaciones, en las que hay que apelar al uso de
matrices homogneas, se cuenta con algunas normas, los siguientes criterios:
Si el sistema fijo (OXYZ) y el transformado (0UVW) concuerdan, la matriz
homognea de transformacin resulta ser la matriz identidad.
(Matriz de orden 4) .
Cuando el sistema transformado resulta de traslaciones y rotaciones definidas
con respecto al sistema fijo, la matriz homognea representativa de cada
transformacin, deber pre-multiplicarse sobre las matrices de las respectivas
transformaciones previas.
Cuando el sistema transformado resulta de traslaciones y rotaciones definidas
con respecto al sistema mvil, la matriz homognea representativa de cada
transformacin, deber post-multiplicarse sobre las matrices de las respectivas
transformaciones previas.
Las orientaciones mencionadas nos permiten argumentar, que para cualquier
operacin que incluya composicin de matrices homogneas, podemos tratarla
como si se efectuara cada transformacin con respecto al sistema de referencia
fijo, o con respecto al sistema de referencia mvil.
Finalmente, presentamos una ilustracin grafica de un ejemplo de
transformaciones diversas para localizar un objeto.
LECCIN 5: CUATERNIOS
La variedad de movimientos contemplados en cualquier faena habitual de los
robots, engloba eventos compuestos por giros y cambios de orientacin de
naturaleza diversa y compleja. Esto hace que tengamos que disponer de
recursos y herramientas matemticas verstiles, que sean capaces de
responder a las exigencias propias de las caractersticas mencionadas. Los
cuaternios se constituyen en los dispositivos creados para tal fin, pudiendo ser
empleados como herramienta analtica de gran efectividad y flexibilidad
computacional, para tratar y ocuparse de los giros y orientaciones.
Un cuaternio Q est constituido por cuatro componentes los
cuales representan las coordenadas propias de cuaternio en la base {e, i, j, k}.
Resumiendo, un cuaternio es un mtodo compacto que nos permite
representar una rotacin en 3D, presentando ventajas computacionales, entre
las cuales destacamos la velocidad y la robustez numrica.
IMPLEMENTACIN COMPUTACIONAL:
DESCRIPCIN PRELIMINAR
Para implementar un cuaternio, establecemos su respectivo objeto, el cual
tiene en Matlab un constructor, llamado quaternin. El empleo esta matizado
por tres formas, a saber: la primera nos retorna un nuevo objeto con el mismo
valor de su argumento. La segunda forma inicializa el cuaternio para una
rotacin del ngulo (theta) alrededor del vector v. La tercera forma establece
los cuatro elementos del cuaternio de manera directa, para una rotacin
equivalente de la matriz de rotacin 3x3, o la sub-matriz de rotacin de una
transformacin homognea 4x4.
b=1:3:12
b=
1 4 7 10
c=1:1.5:12
c=
1.0000 2.5000
d=8:1:1
d=
8 7 6
4.0000
5.5000
7.0000
8.5000
10.0000
10
A(3,1:4) % Extrae los 4 primeros elementos de la tercera fila
ans =
9 7 6 12
A(2,:) % Extrae los elementos de la segunda fila
ans =
5 11 10 8
A(end,:) % Se extrae la cuarta fila
ans =
4 14 15 1
A (2:4,:) % Extrae los elementos de las filas 2, 3 y 4
ans =
5 11 10 8
9 7 6 12
4 14 15 1
% OPERADORES DE DIVISION: Para un sistema de ecuaciones lineales Ax=b, en
donde x y b son vectores columna, y A es una matriz cuadrada invertible.
% x= inv(A)*b
% x= A\b
% EJERCICIOS ILUSTRATIVOS
% 1) A=[2 4],b=[4]
A=[2 4],b=[4]
A=
2 4
b=
4
x=A.\b
x=
2 1
% 2) A=[2 4;2 0;0 2], b=[4 0 0]'
A=[2 4;2 0;0 2], b=[4 0 0]'
A=
2 4
2 0
0 2
b=
4
0
0
x=A\b, resto=A*x-b
x=
0.3333
0.6667
resto =
0.6667
0.6667
1.3333
% OPERADORES MATRICIALES (*, ^, \ y /) APLICAR ELEMENTO A
ELEMENTO.
[1 2 3 4 5]^2
??? Error using ==> mpower
Matrix must be square.
[1 2 3 4 5]^2
ans =
1 4 9 16
[1
2 3
25
4 5]*[1 -1 1 -1 2]
0.6068
Z(v)
ans =
0.9501
0.8913
0.4860
0.4860
0.8913
0.7621
0.4565
0.8214
0.4447
0.6154
0.7919
0.9218
0.7382
J=Y(6:1:1)
J=
0.9218 0.7919
0.6154
0.4447
0.8214
0.0185
1.5
3];b=[2
18
a.*b
ans =
2.0000
3.7500
6.0000
a.^b
ans =
1.0000
2.7557
0.1111
a.\b
ans =
2.0000
1.6667
0.6667
c.^a
ans =
6.0000
14.6969
216.0000
2.5
2]; c=6;
7
8
9
B=A'
B=
1 4
2 5
3 6
7
8
9
15
16
22
3
9
ans =
23 7
10 19
g=[1 3 5
g=
1 3 5 7
7]
B(g),B(3),B(5)
ans =
17 4 11 5
ans =
4
ans =
11
8
14
20
21
2
15
16
22
3
9
% L(:) Representa un vector columna con las columnas de L una detrs de otra.
11
3
A-B
ans =
7 -19 5
-4 3 -3
B-A
ans =
-7 19 5
4 -3 3
A*C
ans =
-42
39
65 -100
C*A
ans =
-18 -78 9
-15 -100 15
3 118 -24
C*B
ans =
-63 -3
6
-78 16 19
87 -55 -43
B*C
ans =
-8
-17
38 -82
A/B
ans =
-0.3645
0.2265
0.2523
0.6839
A\B
ans =
0.3429
0.7286
0
2.4571
-0.5286
0
B\A
ans =
0.2681
0.3696
0
1.2464
-0.1739
0
1.4000
-0.4000
0
-0.1522
0.1957
0
H^p
ans =
4 25
16 81
p.^H
ans =
4 32
16 512
H^p
ans =
24 55
44 101
p^H
ans =
1.0e+003 *
0.4455 1.0202
0.8162 1.8738
2 3;4 5 6;7 8 9]
2 3
5 6
8 9
-0.4504
0.9007
-0.4504
ans =
1 4 7
2 5 8
3 6 9
ans =
0
ans =
2
ans =
15
ans =
3
ones(2,3)
ans =
1 1
1 1
1
1
ones(4)
ans =
1 1
1 1
1 1
1 1
1
1
1
1
1
1
1
1
zeros(2,3)
ans =
0 0 0
0 0 0
zeros(3)
ans =
0 0 0
0 0 0
0 0 0
eye(5)
ans =
1
0
0
0
0
0
1
0
0
0
0
0
1
0
0
eye(2,3)
ans =
1 0 0
0 1 0
diary off
0
0
0
1
0
0
0
0
0
1
EJERCICIOS ILUSTRATIVOS
1. Segn la figura, en el sistema O'UVW esta trasladado un vector p (6, 3,8) con
respecto al sistema OXYZ. Calcular las coordenadas (rx, ry, rz) del vector r cuyas
coordenadas con respecto al sistema O'UVW son ruvw (2, 7,3).
EJERCICIOS ILUSTRATIVOS
1. Segn la figura adjunta, el sistema 0UVW se encuentra girado -90 grados
alrededor del eje OZ con respecto al sistema OXYZ. Calcular las
coordenadas del vector rxyz si ruvw=[4,8,12]'
0
0
1
0
0
0
0
1
1.0000
0.0000
0
0
0
0
1.0000
0
0
0
0
1.0000
rxyz=t1*ruvw
rxyz =
8.0000
- 4.0000
12.0000
1.0000
2. Un sistema OUVW ha sido girado 90 grados alrededor del eje OX y
posteriormente trasladado un vector p(8,-4,12) con respecto al sistema
OXYZ (figura adjunta). Calcular las coordenadas (rx,ry,rz) del vector r con
coordenadas ruvw(-3,4,-11).
Queda as:
Txa=[1 0 0 8;0 0 -1 -4;0 1 0 12;0 0 0 1]
Txa =
1 0 0 8
0 0 1 4
0 1 0 12
0 0 0 1
[ru rv rw 1]'= ruvw=[-3,4, -11,1]'
% Ahora ya podemos aplicar [rx ry rz 1]'=T[ru rv rw 1]' , ecuacin (IV).
Txa=[1
Txa =
1
0
0
0
0 8;0
0
0
1
0
0 8
1 4
0 12
0 1
ruvw=[3,4,11,1]'
ruvw =
3
4
11
1
rxyz=Txa*ruvw
rxyz =
5
7
16
1
diary off
0 -1 -4; 0
12;0
1]
sena
pycosapzsena;0
sena
cosa
Traslacin del vector px, y, z seguida de rotacin de un ngulo b sobre el eje OY.
T(p,(y,b))= [cosb 0 senb pxcosb+pzsenb;0
pzcosbpxsenb;0 0 0 1] (II).
py;senb
cosb
Traslacin del vector px, y, z seguida de rotacin de un ngulo c sobre el eje OZ.
T(p,(z,c))=[cosc senc 0
1 pz;0 0 0 1] (III).
pxcoscpysenc;senc
cosc
0 pxsenc+pycosc;0
PERSPECTIVA Y ESCALADO
Cuando en las componentes de un vector es posible la realizacin de un
escalado, podemos aplicar las matrices homogneas. Para lograr esto, es
suficiente emplear una matriz del tipo: T=[a 0 0 0;0 b 0 0;0 0 c 0; 0 0 0 1].
El caso tpico es transformar el vector r(x, y, z) en el vector r (ax, by, cz). Si se
trata de hacer un escalado global de las tres componentes, tenemos el recurso
apropiado con la matriz T=[1 0 0 0;0 1 0 0;0 0 1 0;0 0 0 s].
EJERCICIOS ILUSTRATIVOS
1. Un sistema OUVW ha sido trasladado un vector p(8,-12,-4) con respecto
al sistema OXYZ y girado 90 grados alrededor del eje OX (figura adjunta).
Calcular las coordenadas (rx,ry,rz)del vector r de coordenadas ruvw (3,4,11).
Tpxa =
1
0
0
0
0
0
1
0
0 8
1 12
0 4
0 1
ruvw=[3,4,11,1]'
ruvw =
3
4
11
1
rxyz=Tpxa*ruvw
rxyz =
5
1
0
1
2. Composicin de matrices homogneas: Se quiere obtener la matriz de
transformacin que representa al sistema O'UVW obtenido a partir del
sistema OXYZ mediante un giro de ngulo de -90 grados alrededor del eje
OX, de una traslacin de vector p(x, y, z) , (5,5,10) y un giro de 90 grados
sobre el eje OZ.
Solucin: Procedemos a ingresar los valores de la matriz T(p):
Tp=[1 0 0 5;0 1 0 5;0 0 1 1 0;0 0 0 1]
Y empleando comandos especiales de ejecucin directa:
Tp=[1 0 0 5;0 1 0 5;0 0 1 10;0 0 0 1]
Tp =
1
0
0
0
0
1
0
0
0 5
0 5
1 10
0 1
rotz(pi/2),rotx(-pi/2)
ans =
0.0000 -1.0000
1.0000
0.0000
0
0
0
0
0
0
1.0000
0
0
0
0
1.0000
0
1.0000
0.0000
0
0
0
0
1.0000
ans =
1.0000
0
0
0
0
0.0000
-1.0000
0
-5.0000
5.0000
10.0000
1.0000