Академический Документы
Профессиональный Документы
Культура Документы
(
=
(
(
c. Determine la matriz de traslacin T (L) para L centmetros en el eje adecuado.
En el sistema coordenado el eje Y es el que se encuentra en la direccin de la barra,
por lo cual la traslacin se realiza sobre el eje Y, entonces se tiene la matriz de
traslacin de la siguiente forma:
1 0 0 0
0 1 0
0 0 1 0
0 0 0 1
d
L
T
(
(
(
=
(
(
9
d. Usando los resultados de a, b y c, calcule la matriz de transformacin as:
1 0 0 1 0 0 0 1 0 0 0
0 1 0 0 0 cos sin 0 0 1 0
0 0 1 0 0 sin cos 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
b
e
d
L
T
u u
u u
( ( (
( ( (
( ( (
=
( ( (
( ( (
1 0 0
0 cos sin cos
0 sin cos sin
0 0 0 1
b
e
d
L
T
L
u u u
u u u
(
(
(
=
(
(
2. Determine la matriz de transformacin
e
c
T as:
a. Determine la matriz de traslacin T para X1 centmetros en el eje X, Y1
centmetros en el eje Y, y Z1 centmetros en el eje Z.
La matriz de traslacin en el eje X es:
1
1 0 0
0 1 0 0
0 0 1 0
0 0 0 1
X
X
T
(
(
(
=
(
(
La matriz de traslacin en el eje Y es:
1
1 0 0 0
0 1 0 0
0 0 1
0 0 0 1
Y
T
Z
(
(
(
=
(
(
La matriz de traslacin en el eje Z es:
1
1 0 0 0
0 1 0
0 0 1 0
0 0 0 1
Y
Y
T
(
(
(
=
(
(
10
La matriz de transformacin total es
X Y Z
T T T
1
1
1
1 0 0 1 0 0 0 1 0 0 0
0 1 0 0 0 1 0 0 1 0 0
0 0 1 0 0 0 1 0 0 0 1
0 0 0 1 0 0 0 1 0 0 0 1
T
X
Y
T
Z
( ( (
( ( (
( ( (
=
( ( (
( ( (
1
1
1
1 0 0
0 1 0
0 0 1
0 0 0 1
T
X
Y
T
Z
(
(
(
=
(
(
b. Determine la matriz de rotacin R usando el eje adecuado o , y .
La matriz de rotacin para el eje X es:
,
1 0 0 0
0 cos sin 0
0 sin cos 0
0 0 0 1
X
T
o
o o
o o
(
(
(
=
(
(
La matriz de rotacin para el eje Y es:
,
cos 0 sin 0
0 1 0 0
sin 0 cos 0
0 0 0 1
Y
T
|
| |
| |
(
(
(
=
(
(
La matriz de rotacin para el eje Z es:
,
cos sin 0 0
sin cos 0 0
0 0 1 0
0 0 0 1
Z
T
(
(
(
=
(
(
, , , R X Y Z
T T T T
o |
=
11
1 0 0 0 cos 0 sin 0 cos sin 0 0
0 cos sin 0 0 1 0 0 sin cos 0 0
0 sin cos 0 sin 0 cos 0 0 0 1 0
0 0 0 1 0 0 0 1 0 0 0 1
R
T
| |
o o
o o | |
( ( (
( ( (
( ( (
=
( ( (
( ( (
cos cos cos sin sin 0
cos sin cos sin sin cos cos sin sin sin cos sin 0
sin sin cos cos sin cos sin cos sin sin cos cos 0
0 0 0 1
R
T
| | |
o o | o o | | o
o o | o o | o |
(
(
+
(
=
( +
(
c. Usando los resultados de a y b, calcule la matriz de transformacin as:
e
c T R
T T T =
1
1
1
1 0 0 cos cos cos sin sin 0
0 1 0 cos sin cos sin sin cos cos sin sin sin cos sin 0
0 0 1 sin sin cos cos sin cos sin cos sin sin cos cos 0
0 0 0 1 0 0 0 1
e
c
X
Y
T
Z
| | |
o o | o o | | o
o o | o o | o |
( (
( (
+
( (
=
( ( +
( (
1
1
1
cos cos cos sin sin
cos sin cos sin sin cos cos sin sin sin cos sin
sin sin cos cos sin cos sin cos sin sin cos cos
0 0 0 1
e
c
X
Y
T
Z
| | |
o o | o o | | o
o o | o o | o |
(
(
+
(
=
( +
(
Determine la matriz de transformacin completa usando los resultados de los pasos
anteriores as:
b b e
c e c
T T T =
1
1
1
1 0 0 cos cos cos sin sin
0 cos sin cos cos sin cos sin sin cos cos sin sin sin cos sin
0 sin cos sin sin sin cos cos sin cos sin cos sin sin cos cos
0 0 0 1 0 0 0 1
b
c
d X
L Y
T
L Z
| | |
u u u o o | o o | | o
u u u o o | o o | o |
( (
( (
+
( (
=
( ( +
( (
Despus de realizar la multiplicacin entre las matrices se obtiene la matriz de
transformacin final
1
1 1
cos cos cos sin sin
cos (cos sin cos sin sin ) sin (sin sin cos cos sin ) cos (cos sin cos sin sin ) sin(cos sin cos sin sin ) cos (cos sin ) sin (cos cos ) cos ( ) sin
cos (sin sin cos co
X d
Y L Z
| | |
u o o | u o o | u o o | o o | u | o u o | u u
u o o
+
+ + + +
1 1
s sin ) sin (cos sin cos sin sin ) cos (cos sin cos sin sin ) sin (cos sin cos sin sin ) cos (cos cos ) sin (cos sin ) cos sin ( )
0 0 0 1
Z Y L | u o o | u o o | u o o | u o | u | o u u
(
(
(
( + + + + + + + +
(
b
c
T
12
c. Determine la posicin y orientacin del objeto considerando: X1=2 [cm], Y1=2 [cm],
Z1= - 3 [cm], o =30, =25, =10, d=6 [cm], =20, y L=12 [cm].
Reemplazando los valores en la matriz
b
c
T , y se obtiene
0.8925 0.1574 0.4226 8
0.4304 0.5768 0.6943 14.1818
0.1345 0.8016 0.5826 1.9692
0 0 0 1
T
(
(
(
=
(
(
Donde el vector de posicin es:
8
14.1818
1.9692
(
(
(
(
Y la matriz de orientacin es:
0.8925 0.1574 0.4226
0.4304 0.5768 0.6943
0.1345 0.8016 0.5826
(
(
(
(
Por ltimo presente un esquema del espacio de trabajo del robot, suponiendo que la
articulacin de la base solamente puede moverse 7 centmetros en direccin positiva o
negativa, y la articulacin de rotacin solo puede girar entre 0 y 90.
A continuacin se muestra el espacio de trabajo del robot,
13
FASE 3 TRABAJO COLABORATIVO 2
Teniendo en cuenta la metodologa sugerida en la fase 2, para el robot de la siguiente
figura encuentre la matriz de transformacin homognea desde el origen del sistema de
coordenadas de la base hasta el origen del sistema de referencia del efector final.
En la Figura 2 se muestra la asignacin de los ejes coordenados para cada uno de los
ejes de eslabones y articulaciones del robot.
Figura 2 Ejes coordenados para el movimiento de las articulaciones
Para hallar la matriz de transformacin homognea que relacione el eje coordenado de
referencia con el eslabn 1 se realiza una rotacin en el eje z seguida de una traslacin
en el eje z, a continuacin se desarrolla:
Rotacin en el eje Z
,
cos sin 0 0
sin cos 0 0
0 0 1 0
0 0 0 1
Z
R
u
u u
u u
(
(
(
=
(
(
14
Traslacin en Z
, 1
1 0 0 0
0 1 0 0
0 0 1 1
0 0 0 1
Z L
T
L
(
(
(
=
(
(
0
1
0
1
cos sin 0 0 1 0 0 0
sin cos 0 0 0 1 0 0
0 0 1 0 0 0 1 1
0 0 0 1 0 0 0 1
cos sin 0 0
sin cos 0 0
0 0 1 1
0 0 0 1
T
L
T
L
u u
u u
u u
u u
( (
( (
( (
=
( (
( (
(
(
(
=
(
(
Para hallar la matriz de transformacin homognea que relacione el eje coordenado
eslabn 1 con el eslabn 2 se realiza una rotacin en el eje x seguida de una traslacin
en el eje y, a continuacin se desarrolla:
Rotacin en X
1
1 1
,
1 1
1 0 0 0
0 cos sin 0
0 sin cos 0
0 0 0 1
X
R
o
o o
o o
(
(
(
=
(
(
Traslacin en Y
, 2
1 0 0 0
0 1 0 2
0 0 1 0
0 0 0 1
Y L
L
T
(
(
(
=
(
(
1 1 1
2
1 1
1 0 0 0 1 0 0 0
0 cos sin 0 0 1 0 2
0 sin cos 0 0 0 1 0
0 0 0 1 0 0 0 1
L
T
o o
o o
( (
( (
( (
=
( (
( (
15
1 1 1
2
1 1
1 0 0 0
0 cos sin 2
0 sin cos 0
0 0 0 1
L
T
o o
o o
(
(
(
=
(
(
Para hallar la matriz de transformacin homognea que relacione el eje coordenado
eslabn 2 con el eslabn 3 se realiza una rotacin en el eje x seguida de una traslacin
en el eje y, a continuacin se desarrolla:
Rotacin en X
3
2 2
,
2 2
1 0 0 0
0 cos sin 0
0 sin cos 0
0 0 0 1
X
R
o
o o
o o
(
(
(
=
(
(
Traslacin en Y
, 3
1 0 0 0
0 1 0 3
0 0 1 0
0 0 0 1
Y L
L
T
(
(
(
=
(
(
2 2 2
3
2 2
2 2 2
3
2 2
1 0 0 0 1 0 0 0
0 cos sin 0 0 1 0 3
0 sin cos 0 0 0 1 0
0 0 0 1 0 0 0 1
1 0 0 0
0 cos sin 3
0 sin cos 0
0 0 0 1
L
T
L
T
o o
o o
o o
o o
( (
( (
( (
=
( (
( (
(
(
(
=
(
(
Para hallar la matriz de transformacin homognea que relacione el eje coordenado de
referencia con el sistema de referencia en el efector final del robot se calcula de la
siguiente forma:
0 0 1 2
3 1 2 3
T T T T =
1 1 2 2 0
3
1 1 2 2
cos sin 0 0 1 0 0 0 1 0 0 0
sin cos 0 0 0 cos sin 2 0 cos sin 3
0 0 1 1 0 sin cos 0 0 sin cos 0
0 0 0 1 0 0 0 1 0 0 0 1
L L
T
L
u u
u u o o o o
o o o o
( ( (
( ( (
( ( (
=
( ( (
( ( (
16
Realizando la multiplicacin de las matrices tenemos,
1 2 1 2 1 2 2 1 1 0
3
1 2 2 1 1 2 1 2 1
cos sin 0 0 1 0 0 0
sin cos 0 0 0 cos cos sin sin cos sin cos sin 2 3cos
0 0 1 1 0 cos sin cos sin cos cos sin sin 3sin
0 0 0 1 0 0 0 1
L L
T
L L
u u
u u o o o o o o o o o
o o o o o o o o o
( (
( (
+
( (
=
( ( +
( (
La matriz de transformacin homognea final es:
1 2 1 2 1 2 2 1 1
1 2 1 2 1 2 2 1 1 0
3
1 2 2 1 1 2 1 2
cos sin (sin sin cos cos ) sin (cos sin cos sin ) sin ( 2 3cos )
sin cos (cos cos sin sin ) cos (cos sin cos sin ) cos ( 2 3cos )
0 cos sin cos sin cos cos sin sin 1
L L
L L
T
L
u u o o o o u o o o o u o
u u o o o o u o o o o u o
o o o o o o o o
+ +
+ +
=
+ +
1
3sin
0 0 0 1
L o
(
(
(
(
(
17
CONCLUSIONES
- Existen algoritmos y mtodos sistemticos para la obtencin de la matriz de
transformacin homognea como el de Denavit-Hartenberg, que para robot de
varios grados de libertad son de gran ayuda para obtener su cinemtica directa,
porque utilizado mtodos geomtricos el anlisis es extenso, complejo y es ms
susceptibles a errores de interpretacin.
- En el desarrollo de los ejercicios del trabajo colaborativo, al realizar el modelado
de la cinemtica directa de los robots se evidencia el nivel computacional
requerido para el software para resolver y controlar los movimientos de las
articulaciones del robot.
- Dependiendo de la configuracin y composicin de las articulaciones del robot
se debe escoger el adecuado sistema de coordenadas que permitan representar
los movimientos que puede realizar, de la correcta eleccin depende la
complejidad de las operaciones matemticas a resolver en la cinemtica directa.
18
REFERENCIAS
- Barrientos, A. (2009). Fundamentos de robtica. Segunda edicin. Espaa.
Mc Graw Hill
- Wikipedia. (2012). Traslacin: geometra Recuperado el 2 de Mayo de 2012,
de http://es.wikipedia.org/wiki/Traslaci%C3%B3n_%28geometr%C3%ADa%29
- Revista Online de divulgacin y disertacin cientfico cultural. (2012).
Inteligencia artificial y robtica: investigacin de sistemas de cmputo.
Recuperado el 3 de mayo de 2012, de
http://www.kercentral.com/tecnologia/inteligencia-artificial-investigacion-
sistemas-computo.pdf
- Valderrama, G. (2010). Modulo Robtica. Segunda edicin. Colombia. UNAD
- Protn. (2012). Cinemtica. Recuperado el 3 de mayo de 2012, de
http://proton.ucting.udg.mx/materias/robotica/r166/r91/r91.htm
- Aula Macedonia. (2012) Transformaciones geomtricas. Recuperado el 3 de
mayo de 2012, de http://macedoniamagazine.frodrig.com/opengl6.htm