Académique Documents
Professionnel Documents
Culture Documents
UNIVERSIDAD DE CARABOBO
REA DE ESTUDIOS DE POSTGRADO
FACULTAD DE INGENIERA
MAESTRA EN INGENIERA MECNICA
UNIVERSIDAD DE CARABOBO
REA DE ESTUDIOS DE POSTGRADO
FACULTAD DE INGENIERA
MAESTRA EN INGENIERA MECNICA
UNIVERSIDAD DE CARABOBO
AREA DE ESTUDIOS DE POSTGRADO
FACULTAD DE INGENIERA
MAESTRA EN INGENIERA MECNICA
CONSTANCIA DE APROBACIN
Nosotros, los abajo firmantes, miembros del jurado designado para evaluar el trabajo
de maestra titulado: DISEO Y SIMULACIN DE UNA MANO MECNICA
PARA SER UTILIZADA COMO UN EFECTOR FINAL ROBTICO, realizado
por el ingeniero Jos Gutirrez, cdula de identidad N 11.152.350, hacemos constar
que hemos revisado y aprobado dicho trabajo.
________________________
Prof. David Ojeda
Presidente del Jurado
_________________________
Prof. Nelson Vilchez
Jurado
_______________________
Prof. Fernando Montero
Jurado
NDICE GENERAL
Contenido
pgina
Introduccin
Captulo I: El problema
1.1 Planteamiento del problema
1.5 Delimitacin
1.6 Limitaciones
13
2.2.1 Robtica
13
16
2.2.3 Cinemtica
23
2.3 Roboworks
27
35
36
37
3.4 Recursos
38
39
47
48
51
65
69
Conclusiones
78
Recomendaciones
79
Revisin bibliogrfica
80
NDICE DE FIGURAS
Figura
pgina
14
15
18
19
21
22
25
28
29
30
30
31
32
33
33
34
40
41
43
43
45
46
47
Figura N 4.8 rea de trabajo del dedo ndice y del dedo pulgar.
49
50
51
52
53
54
56
66
68
71
72
74
75
75
76
77
NDICE DE TABLAS
Tabla
pgina
20
20
20
41
42
45
46
47
48
57
57
10
INTRODUCCIN
El diseo de sistemas robticos como hoy en da se conoce, tiene sus orgenes
desde hace muchos aos ya que desde el principio de los tiempos, el hombre ha
deseado crear elementos artificiales que realicen sus tareas repetitivas, pesadas o
difciles de realizar por el ser humano. La humanidad ha tenido la obsesin de crear
vida artificial desde el principio de los tiempos y muchos han sido sus intentos por
lograrlos.
El campo de la ingeniera no est exento de esa premisa ya que, por
excelencia, posee una actitud de investigacin cientfica. En el rea de la ingeniera
mecnica, se poseen las herramientas necesarias para disear dispositivos compuestos
por una inmensa gama de componentes y mecanismos. De igual forma, esta actitud
de investigacin est presente en otras ramas que son base para el desarrollo de la
robtica.
Basndose en estas generalidades se tiene la presente investigacin la cual
presenta el objetivo de disear una mano mecnica que pueda ser utilizada como un
efector final robtico de tal forma que se pueda acoplar a un brazo robot y, con el
conjunto, pueda desarrollar distintas tareas de aprehensin y manipulacin.
Por lo explicado anteriormente se presenta el siguiente de Trabajo de Grado el
cual se divide en cuatro captulos: en el captulo I se muestran los objetivos
especficos y alcances del trabajo, entre los cuales destaca el desarrollo de un modelo
inicial al cual se le realizar un estudio cinemtica directo del mismo para, en base a
la posicin de cada uno de los elementos que componen el dedo, obtener la posicin
del extremo del dedo.
11
12
CAPTULO I
EL PROBLEMA
13
14
15
1.5.- Delimitacin:
El tipo de agarre que se estudiar para el diseo de la mano mecnica ser el de
agarre de tipo punta.
El modelo de mano mecnica se disear con dos dedos, uno de ellos con dos
grados de libertad y el otro con tres grados de libertad para realizar el tipo de agarre
mencionado.
El movimiento de la mano mecnica con los grados de libertad establecidos se
realizar en un solo plano.
El estudio cinemtico se corresponder a un estudio cinemtico directo.
La simulacin se realizar a travs de un programa de computacin.
1.6.- Limitaciones:
La limitante de este trabajo es la poca informacin referente al diseo de
manos robticas en Venezuela lo cual hace necesaria la bsqueda de informacin
en entes fuera del pas. El resultado de este trabajo de investigacin se entregar
como requisito para la obtencin del grado de Magster por lo que el tiempo
mximo fijado para la culminacin del mismo ser aquella que fije la comisin de
postgrado de ingeniera mecnica. La tecnologa a utilizar para el desarrollo de la
simulacin del movimiento de la mano ser aquella que se encuentre disponible al
momento de su realizacin. De igual forma la ausencia de un manipulador real
16
17
CAPTULO II
MARCO TERICO
2.1 Antecedentes
A nivel internacional se han desarrollado una serie de investigaciones en cuanto al
desarrollo de manos y dedos robticos para el proceso de agarre y manipulacin.
Para la realizacin del siguiente proyecto se realiz una revisin de algunos trabajos
realizados a nivel mundial en referencia a este tema y, aunque son muchos los
estudios obtenidos a nivel internacional, a nivel nacional son contados los trabajos
desarrollados lo cual indica lo novedoso del tema y por lo tanto la importancia de su
estudio.
Review of virtual environment interface technology
Youngblut, Christine y otros. (1996)
En este trabajo se determinaron parmetros relacionados con la fuerza que realiza
el dedo ndice humano para realizar el agarre y se determin que por breves perodos
de tiempo el dedo ndice puede ejercer una fuerza de 30 50 N y para perodos
prolongados la fuerza vara de 4 7 N.
Diseo mecatrnico de un dedo antropomrfico
Garca-Cordova, Francisco y Martnez, Jos. (1999)
En este trabajo se desarroll un prototipo de dedo antropomrfico basado en un
sistema ligero y pequeo cuyo movimiento est es representado por un sistema de
transmisin basado en tendones y motores de corriente continua.
El dedo
antropomrfico diseado presenta dos grados de libertad. Cada eslabn del dedo
tiene asociado dos tendones, el primero causa la flexin del dedo y el segundo la
extensin del mismo. El control del dedo est basado en controladores neuronales
basados en modelos neurobiolgicos. En este diseo se busc la simulacin de todos
sus elementos con respecto al de un dedo humano.
18
19
20
21
22
23
El trmino robot aparece por primera vez en el ao 1921, en la obra teatral R.U.R
(Rossums Universal Robots) del novelista y autor dramtico checo Karen Capek en
cuyo idioma la palabra robota significa fuerza de trabajo o servidumbre.
El trmino tiene amplia aceptacin y pronto se aplica a autmatas construidos en
los aos veinte y treinta que se exhiben en ferias, promociones de productos y otras
aplicaciones.
24
Las articulaciones
Articulacin i
Eslabn i-1
Eslabn i
25
grados de libertad; y por ltimo, la articulacin esfrica combina tres giros en tres
direcciones perpendiculares en el espacio.
En cuanto a los efectores finales, se puede mencionar que son los elementos que se
colocan en el extremo del ltimo enlace el manipulador y que suministra la capacidad
de agarre del objeto que se pretende manipular, o la colocacin de una herramienta
apropiada para la tarea (pintura, soldadura, entre otros).
26
Las caractersticas que hay que tener en cuenta para su diseo son: capacidad de
carga, fuerza de agarre, geometra y dimensiones de los objetos que debe manejar,
tolerancias, tipos de movimientos que puede ejecutar, alimentacin (neumtica,
elctrica, hidrulica), tiempo de actuacin del mecanismo de agarre y caracterstica de
la superficie de contacto.
Los efectores finales ms simples son pinzas mecnicas, tpicamente con dos
dedos y accionamiento neumtico todo/nada.
Existen tambin dedos o pinzas con material deformable para evitar que se
produzca el deslizamiento de la pieza, igualmente existen pinzas con sujeciones
interiores y exteriores, de apertura amplia entre otras.
Dentro de las nuevas estructuras para el diseo de robots manipuladores se han
desarrollado en los ltimos aos tecnologas robticas que han permitido abordar
aplicaciones no convencionales entre las cuales se encuentran: los robots redundantes
con un incremento en el nmero de grados de libertad; robots flexibles los cuales son
tiles cuando se requiere bajo peso y gran alcance; y, por ltimo las manos mecnicas
o robticas los cuales son rganos terminales o efectores finales de robots para la
manipulacin con mltiples dedos.
2.2.2
La mano humana
27
Tambin existen razones de carcter tcnico para intentar simular la mano humana.
La mano humana tiene un nmero alto de grados de libertad, alta relacin
fuerza/peso, bajo factor de forma (es compacta) y un sistema sensorial complejo
[Suarez y Grosh, 2005].
La mano humana cuenta con 25 grados de libertad, que permiten mltiples
configuraciones de aprehensin y manipulacin. Cada dedo cuenta, a excepcin del
dedo pulgar, con dos articulaciones tipo bisagra (rotacin en una sola direccin) y una
articulacin en la base con dos grados de libertad, donde uno de los dos ejes de
rotacin es paralelo a los ejes de rotacin de las articulaciones tipo bisagra y el
segundo es perpendicular a este y normal a la palma.
La suma de todas las caractersticas mencionadas, induce a utilizar la mano
humana como un punto de referencia o modelo para el desarrollo de manipuladores o
efectores finales, por lo tanto es importante realizar un estudio de la mano humana
que permita obtener la informacin necesaria para justificar su analoga en el diseo
de manipuladores robticos.
El esqueleto de la mano humana tiene tres regiones: 1) el carpo, de localizacin
proximal, 2) el metacarpo, de localizacin intermedia y 3) las falanges, de
localizacin distal, esta disposicin se muestra en la figura N 2.3.
28
29
30
Tabla N 2.1 Dimensiones del dedo ndice (en milmetros). (Garca y otros, 1999)
Longitud de la falange distal
19,67 1,03
24,67 1,37
43,57 0,98
5,58 0,92
7,57 0,45
15,57 0,84
Tabla N 2.2 Rangos de movimientos del dedo ndice. (Garca y otros, 1999)
Articulacin
Movimiento
Rango de movimiento
DIP
Flexin/extensin
50.36/6.6
PIP
Flexin/extensin
89.5/11.7
MCP
Flexin/extensin
85.3/18.4
MCP
Abduccin/adduccin
50.4/6.6
Movimiento
Rango de movimiento
DIP
Flexin/extensin
80/0
MCP
Flexin/extensin
80/5
31
Uno de los aspectos importantes a precisar, cuando se utiliza una mano para el
agarre o manipulacin de piezas, consiste en definir de qu forma la mano humana
toma un objeto o, en otras palabras, que modelos adopta la mano cuando toma un
objeto; en este sentido Cutkosky (1989) desarroll un sistema de clasificacin o
taxonoma de agarre en donde realiza una aproximacin de cul tipo de agarre se
debe realizar dadas las restricciones impuestas por los objetos de agarre. En 1.919,
Schlesinger desarroll una clasificacin de la taxonoma para el estudio de la destreza
de la mano humana. Este autor agrup en seis categoras las estrategias de agarre de
la mano humana: agarre cilndrico (cylindrical grasp), de punta (tip), de gancho (hook
o snap), de palma (palmar) esfrico (spherical grasp) y de lado (lateral), como es
mostrado en la figura N 2.5.
De punta
Cilndrica
De gancho
Palmar
Esfrica
Lateral
32
3
2
FM = FP
Ecuacin N 2.1
FD =
7
FP
18
Ecuacin N 2.2
FD =
7
FM
12
Ecuacin N 2.3
FM
FP
FD
33
2.2.3 Cinemtica
La obtencin de la
34
Se puede considerar que una matriz homognea se haya compuesta por cuatro
submatrices de distinto tamao: una submatriz R3x3 que corresponde a una matrz de
rotacin; una submatrz P3x1 que corresponde al vector de traslacin; una submatrz
f1x3 que representa una transformacin de perspectiva y una submatrz W1x1 que
representa un escalado global, por lo que se tiene que:
P3 x1 Rotacin Traslacin
R
T = 3x3
=
i-1
(asociado a un sistema tomado como mvil) y el elemento i-1 (tomado como fijo),
en donde describe la localizacin del sistema de referencia asociado al elemento i,
respecto al sistema de referencia asociado al elemento i-1, mediante una
transformacin homognea que considere cuatro eventos:
1.- Rotacin alrededor del eje Zi-1 en un ngulo qi.
2.- Traslacin a lo largo de Zi-1 una distancia di; vector di (0,0,di)
3.- Traslacin a lo largo de Xi-1 una distancia ai; vector ai (0,0,ai)
4.- Rotacin alrededor del eje Xi, un ngulo i.
35
ai
Zi
Yi
di
Zi-1
Yi-1
Oi-1
Oi
Xi
Xi-1
qi
La expresin matemtica
36
Cos
Sen
i-1
Ai =
0
Sen
Cos
0
0
Cos
Sen
i-1
Ai =
0
0
0
1
0
0 1
0 0
0 0
1 0
0
1
0
0
CosSen
CosCos
Sen
0
0
0
1
0
0 1
0 0
d 0
1 0
0
1
0
0
SenSen
SenCos
Cos
0
0
0
1
0
a 1
0
0 0 Cos
0 0 Sen
0
1 0
0
Sen
Cos
0
0
0
d
aCos
aSen
Ecuacin 2.4
d
37
38
Vista en 3D
Vista de rbol
39
picking que sirve para modificar las propiedades de los elementos del
modelo por medio de un doble clic sobre el elemento simulado.
La vista de rbol es aquella en donde se crean los modelos. Cada forma
representada en la ventana 3D, estar referenciada en esta vista. Existen tres tipos de
elementos que se pueden crear en esta ventana: Formas, Transformaciones y otros.
Para insertar un elemento en esta vista se debe ir al men edit y seleccionar
insert child, despus aparecer una ventana que preguntar qu es lo que se desea
insertar. En esta ventana se encontrarn los tres tipos de elementos mencionados
anteriormente: formas, transformaciones y otros.
Las
formas
son
figuras
bsicas
para
realizar
cualquier
elemento
tridimensional, estas pueden ser: cilindros, conos, discos, esferas y cubos, entre otros,
ver figura 2.9.
40
41
La animacin del modelo creado puede ser realizada por tres medios distintos:
por medio del teclado, por medio de un archivo de datos o a travs de un programa.
42
De tal forma que, al presionar dicha tecla, se realizar la animacin entre los
valores lmites de movimiento y con el incremento establecido.
Para la animacin por medio de un archivo de datos se debe crear primero el
archivo de datos (.dat) en un bloc de notas, colocando las posiciones secuenciales del
movimiento que ir tomando el objeto a animar en una columna de datos, e
identificando cada columna con un tag name que se debe establecer en la etiqueta
control de las propiedades del elemento de transformacin. En la figura 2.14 se
observa el tag name BRAZO dado a un elemento de transformacin (en este caso
de rotacin) y en la figura 2.15 se muestra un ejemplo de las posiciones a tomar dicho
elemento en un bloc de notas.
43
44
45
CAPTULO III
METODOLOGA
46
47
3.4 Recursos
48
CAPTULO IV
DESARROLLO DEL MODELO DE LA MANO MECNICA
49
Las dimensiones del actuador debern ser las adecuadas para el tamao de
las falanges de los dedos.
Dimensiones en milmetros
50
Valor
ngulo de paso
0,9/paso
Torque
60 mNm
Tipo de motor
Hbrido
Nmero de fases
Peso
2
100 g
Otro aspecto importante de los motores de paso es que el control de giro del eje es
relativamente sencillo y se puede realizar de diferentes formas, a continuacin se
explica el control del motor de paso a travs de microcontroladores.
En la figura 4.2 se muestra un ejemplo de conexiones de un motor paso a paso
unipolar mediante el uso de una tarjeta ULN2803 la cual comprende un arreglo de 8
transistores tipo Darlington. Las entradas de activacin (A, B, C y D) se activan
directamente por medio de un microcontrolador.
Figura 4.2 Conexin de un motor paso a paso con una tarjeta ULN2803
El microcontrolador debe programarse para que genere las entradas de activacin
mencionadas anteriormente las cuales deben tener una secuencia determinada segn
51
el tipo de motor de paso utilizado. En este caso, para un motor paso a paso unipolar,
la secuencia de activacin para cada una de las entradas A, B, C y D se realiza segn
el orden dado en la tabla 4.2 de tal forma que en cada paso el eje del motor gira 0,9.
Tabla N 4.2 Secuencia de activacin de las entradas de un motor paso a paso
unipolar
Paso
Entrada A
Entrada B
Entrada C
Entrada D
Activada
Activada
Desactivada
Desactivada
Desactivada
Activada
Activada
Desactivada
Desactivada
Desactivada
Activada
Activada
Activada
Desactivada
Desactivada
Activada
52
Dedo ndice
Base
Dedo pulgar
Eje
Articulacin DIP
Articulacin PIP
Falange media
Motor de paso 2
Falange
Motor de paso 1
Articulacin
Placa
Base
53
54
Motor de paso 5
Falange distal
Falange proximal
Motor de paso 4
Articulacin DIP
Base
Articulacin PIP
Pulgar
Falange
Longitud (mm)
Distal
35
Media
50
Proximal
65
Distal
40
Proximal
60
55
b)
a)
ndice
Pulgar
Articulacin
Flexin
Extensin
50
90
12
Metacarpofalngica (MCP)
85
18
Metacarpofalangica (MCP)
80
80
56
Extensin
Flexin
Extensin
Flexin
DIP
PIP
Flexin
Flexin
DIP
Extensin
Extensin
Flexin
MCP
Extensin
MCP
a)
b)
Densidad (g/cm3)
Acero inoxidable
7,5 7,7
190 - 200
286 500
Aluminio
2,7
69 - 79
150 200
PVC
1,3 1,6
2,4
40 48
7,8
200 - 207
500 1980
Policarbonato
1,2 1,3
2,6
55
57
Uno de los criterios que se toma en esta investigacin para la seleccin del
material de los elementos de la mano consiste en que sta debe ser de bajo peso, en
vista de esto, se escoge como material un aluminio AISI 3003 recocido para el diseo
del dedo. Las propiedades mecnicas ms significativas del aluminio se muestran en
la tabla 4.6.
Tabla 4.6 Propiedades mecnicas del aluminio AISI 3003
Densidad (g/cm3)
2,7
69
159
Una vez definidas las longitudes de las falanges y el rango de movimiento del
dedo a disear, se proceder a continuacin a especificar la posicin de la mano para
el agarre, denominado de tipo punta, con la mano mecnica diseada.
Muchos estudios se han dado a la tarea de clasificar los tipos de agarre, como se
mencion en el captulo II, para esta investigacin se toma en cuenta la clasificacin
dada por Schlesinger (1919) que clasifica el agarre en seis tipos: cilndrico, de punta,
palmar, lateral, esfrico y de gancho; en especfico se trabajar con el tipo de agarre
de punta el cual se usa cuando se sujetan objetos de tamao pequeo como: tornillos,
clavos, pedazos de papel o cualquier otro objeto similar. Por otro lado Cutkoski
(1989) ubica este tipo de agarre dentro de la categora de agarre de precisin el cual
requiere la colocacin de la punta del pulgar en contacto con la punta del o los dems
dedos de la mano (Trew y Everett, 2008). En el caso particular de este trabajo el
agarre de punta se ejecuta con la punta de los dedos pulgar e ndice de la mano
mecnica. Trew y Everett (2008) mencionan que para este tipo de agarre de precisin
58
Figura 4.8 rea de trabajo del dedo ndice y del dedo pulgar
59
Falange
Media
Falange
Proximal
Falange
Distal
rea de
trabajo
Punto de
contacto
Falange
Distal
Falange
Proximal
60
45
Dedo pulgar
26,1
70,3
Base de la mano
19
61
x0
S0
y0
z0
62
de los eslabones del dedo ndice, comenzando con el nmero 1 para el primer
eslabn de la cadena, que en este caso viene dada por la falange proximal, seguido del
eslabn nmero 2 para la falange media y finalizando con el nmero 3 para la falange
distal. Luego corresponde a la enumeracin de los eslabones del dedo pulgar, se
inicia con 1 para la falange proximal y 2 para la falange distal. La enumeracin de
los eslabones se muestra en la figura 4.13.
1
2
1
0
63
2
3
64
65
x4
y4
S4
z4
x3
y3
z3
S3
x2
y2
S2
z2
x1
y1
S1
z1
x1
y2
y3
y4
S1
y1
y0
x4
z1 x0
z0
S0
z2
S2
x2
z3
S3
x3
z4
S4
66
la distancia medida a lo largo del eje xi que se requiere para trasladar el sistema de
coordenadas Si-1 haciendo que su origen coincida con el origen de Si y, por ltimo i
es el ngulo que gira el eje zi-1 alrededor del eje xi para alinearse con el eje zi.
A continuacin, en las tablas 4.7 y 4.8 se especifican las magnitudes de dichos
parmetros vinculadas con las articulaciones presentes en el dedo ndice y pulgar
respectivamente a partir de las dimensiones del modelo de la mano diseada y la
configuracin de las articulaciones que poseen.
Tabla 4.7 Parmetros del algoritmo de Denavit-Hartenberg dedo ndice
Eslabn
di
ai
12 mm
82.6 mm
8 mm
65 mm
8 mm
50 mm
2 mm
35 mm
di
ai
24,02 mm
90
24 mm
57,6 mm
8 mm
60 mm
2 mm
40 mm
Ai, se sustituyen los valores para cada eslabn de sus parmetros correspondientes
segn las tablas 4.4 y 4.5 y se obtienen las matrices mostradas a continuacin:
Para el dedo ndice se tienen las siguientes matrices:
67
0
1
0
0
0 a1
0 0
1 d1
0 1
sen 2
cos 2
0
0
0 a2 cos 2
0 a2 sen 2
d2
1
0
1
sen 3
cos 3
0
0
0 a3 cos 3
0 a3 sen 3
d3
1
0
1
sen 4
cos 4
0
0
0 a4 cos 4
0 a4 sen 4
d4
1
0
1
68
ox
oy
oz
ax
ay
az
Px
Py
Pz
De tal forma que los resultados obtenidos de los parmetros de la matriz son los
siguientes:
nx=(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*cos(4)+(cos(1)*cos(2)*sin(3)-cos(1)*sin(2)*cos(3))*sin(4)
(4.1)
ny=(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*cos(4)+(sin(1)*cos(2)*sin(3)-sin(1)*sin(2)*cos(3))*sin(4)
(4.2)
nz=(sin(2)*cos(3)+cos(2)*sin(3))*cos(4)+(sin(2)*sin(3)+cos(2)*cos(3))*sin(4)
(4.3)
ox=-(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*sin(4)+(cos(1)*cos(2)*sin(3)-cos(1)*sin(2)*cos(3))*cos(4)
(4.4)
oy=-(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*sin(4)+(sin(1)*cos(2)*sin(3)-sin(1)*sin(2)*cos(3))*cos(4)
(4.5)
69
oz=-(sin(2)*cos(3)+cos(2)*sin(3))*sin(4)+(sin(2)*sin(3)+cos(2)*cos(3))*cos(4)
(4.6)
ax= sin(1)
(4.7)
ay=-cos(1)
(4.8)
az=0
(4.9)
Px=(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*a4*cos(4)+(cos(1)*cos(2)*sin(3)cos(1)*sin(2)*cos(3))*a4*sin(4)+cos(1)*cos(2)*a3*cos(3)cos(1)*sin(2)*a3*sin(3)+cos(1)*a2*cos(2)+a1*cos(1)
(4.10)
Py=(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*a4*cos(4)+(sin(1)*cos(2)*sin(3)sin(1)*sin(2)*cos(3))*a4*sin(4)+sin(1)*cos(2)*a3*cos(3)sin(1)*sin(2)*a3*sin(3)+sin(1)*a2*cos(2)+a1*sin(1)
(4.11)
Pz=(sin(2)*cos(3)+cos(2)*sin(3))*a4*cos(4)+(sin(2)*sin(3)+cos(2)*cos(3))*a4*sin(4)+sin(2)*a3*cos(3)+
cos(2)*a3*sin(3)+a2*sin(2)
(4.12)
70
nx
n = n y
nz
ox
o = o y
oz
ax
a = a y
a z
Con las ecuaciones 4.10, 4.11 y 4.12 desarrolladas para los valores de Px, Py y Pz
se puede ubicar el extremo del dedo ndice para cualquier valor de los ngulos 1, 2 ,
3 y 4.
A continuacin se realiza el mismo desarrollo para el dedo pulgar
Inicialmente se obtienen las matrices de paso homognea para cada eslabn
Matriz de paso homognea perteneciente al eslabn 1:
1
0
0
A1 =
0
0
1
0
0
0 a1
0 0
1 0
0 1
71
0 1
1 0
1
A2 =
0 0
0 0
0 0
0 a2
1 d2
0 1
sen 3
cos 3
0
0
0 a3 cos 3
0 a3 sen 3
d3
1
0
1
sen 4
cos 4
0
0
0 a4 cos 4
0 a4 sen 4
d4
1
0
1
ox
oy
oz
ax
ay
az
Px
Py
Pz
Donde:
72
nx=(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*cos(4)+(cos(1)*cos(2)*sin(3)-cos(1)*sin(2)*cos(3))*sin(4)
(4.13)
ny=(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*cos(4)+(sin(1)*cos(2)*sin(3)-sin(1)*sin(2)*cos(3))*sin(4)
(4.14)
nz=(sin(2)*cos(3)+cos(2)*sin(3))*cos(4)+(sin(2)*sin(3)+cos(2)*cos(3))*sin(4)
(4.15)
ox=-(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*sin(4)+(cos(1)*cos(2)*sin(3)-cos(1)*sin(2)*cos(3))*cos(4)
(4.16)
oy=-(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*sin(4)+(sin(1)*cos(2)*sin(3)-sin(1)*sin(2)*cos(3))*cos(4)
(4.17)
oz=-(sin(2)*cos(3)+cos(2)*sin(3))*sin(4)+(sin(2)*sin(3)+cos(2)*cos(3))*cos(4)
(4.18)
ax= sin(1)
(4.19)
ay=-cos(1)
(4.20)
az=0
(4.21)
Px=(cos(1)*cos(2)*cos(3)-cos(1)*sin(2)*sin(3))*a4*cos(4)+(cos(1)*cos(2)*sin(3)cos(1)*sin(2)*cos(3))*a4*sin(4)+cos(1)*cos(2)*a3*cos(3)cos(1)*sin(2)*a3*sin(3)+cos(1)*a2*cos(2)+a1*cos(1)
(4.22)
73
Py=(sin(1)*cos(2)*cos(3)-sin(1)*sin(2)*sin(3))*a4*cos(4)+(sin(1)*cos(2)*sin(3)sin(1)*sin(2)*cos(3))*a4*sin(4)+sin(1)*cos(2)*a3*cos(3)sin(1)*sin(2)*a3*sin(3)+sin(1)*a2*cos(2)+a1*sin(1)
(4.23)
Pz=(sin(2)*cos(3)+cos(2)*sin(3))*a4*cos(4)+(sin(2)*sin(3)+cos(2)*cos(3))*a4*sin(4)+sin(2)*a3*cos(3)+
cos(2)*a3*sin(3)+a2*sin(2)
(4.24)
nx
n = n y
nz
ox
o = o y
oz
ax
a = a y
a z
74
Con las ecuaciones 4.22, 4.23 y 4.24 desarrolladas para los valores de Px, Py y Pz
se puede ubicar el extremo del dedo pulgar para cualquier valor de los ngulos 1, 2,
3 y 4.
4.5 Estudio cinemtica inverso de la mano.
75
AngMedio
orient
Longitud
AngProximal
AngDistal
Py
LyMedia
82,6mm
LxMedia
Px
( 2 ) ( )
Ang Pr oximal =
LyMedia 82,6
LxMedia
= Tg 1
76
= Cos 1
AngMedio =
Long
oximal
LongDistal
2
*
Pr
*
= Cos 1
77
AngDistalP
Py
Ly
AngProxP
24 mm
57,6 mm
Lx
Px
R = ( Lx 2 ) + ( Ly 2 )
Ly
= sen 1
2 * R * Long Pr oxP
= cos 1
Ang Pr oxP =
Long Pr oxP 2 + LongDistP 2 R 2
= cos
2 * Long Pr oxP * LongDistP
1
78
AngDistP =
De esta forma se obtienen, a partir de un anlisis geomtrico, el anlisis cinemtco
inverso de la mano.
4.6 Simulacin de la mano diseada.
las tablas 4.6 y 4.7 y se corresponde al tipo de articulacin, que en el caso de este
trabajo se corresponde con el tipo de bisagra o de rotacin en una sola direccin como
se indic en el captulo II y se le asigna un valor de cero.
Para el dedo ndice, cada eslabn se generan los siguientes comandos:
L1=link([0 82.6 0 0 0]);
L2=link([0 65 0 0 0]);
L3=link([0 50 0 0 0]);
L4=link([0 35 0 0 0]);
Posteriormente se crea la funcin robot la cual genera el modelo del dedo
ndice.
R1=robot({L1 L2 L3 L4});
79
Luego se elabora el modelo del dedo pulgar generando inicialmente los eslabones
del mismo:
L5=link([0 57.6 0 0 0]);
L6=link([0 60 0 0 0]);
L7=link([0 40 0 0 0]);
Se genera el modelo del dedo pulgar con el comando robot:
R2=robot({L5 L6 L7});
Y por ltimo se dibujan tanto el dedo ndice como el dedo pulgar a travs de los
siguientes comandos:
plot(R1, [0 0 0 0])
hold on
plot(R2, [pi/2 0 0])
De esta forma se genera el modelo grfico mostrado en la figura 4.18
80
81
>> a1=82.6;
>> a2=65;
>> a3=50;
>> a4=35;
>> x=(sin(th2).*cos(th3)+cos(th2).*sin(th3))*a4.*cos(th4)+(sin(th2).*sin(th3)+cos(th2).*cos(th3))*a4.*sin(th4)+sin(th2)*a3.*cos(th3)+cos(th2)*a
3.*sin(th3)+a2.*sin(th2);
>> y=(-sin(th2).*sin(th3)+cos(th2).*cos(th3))*a4.*cos(th4)+(-cos(th2).*sin(th3)sin(th2).*cos(th3))*a4.*sin(th4)+cos(th2)*a3.*cos(th3)sin(th2)*a3.*sin(th3)+a2.*cos(th2)+a1;
>> plot(x,y)
>> th33=[0:-0.0157075:-0.345565];
>> th44=3.7*th33;
>> a11=24.02;
>> a22=20;
>> a33=60;
>> a44=40;
>> hold on;
>> plot(x,y)
>> hold on
>> z=cos(th33)*a44.*cos(th44)-sin(th33)*a44.*sin(th44)+a33.*cos(th33)+a22;
>> w=-sin(th33)*a44.*cos(th44)-cos(th33)*a44.*sin(th44)-a33.*sin(th33)+a1;
>> plot(z,w)
Ejecutados estos comandos Matlab realiza la trayectoria que realizaran los dedos
para el agarre tipo punta de la mano, la cual se observa en la figura 4.20 en donde la
trayectoria en azul corresponde a la del dedo ndice y la trayectoria en rojo a la del
dedo pulgar.
82
Figura 4.20 Trayectoria del extremo de los dedos ndice y pulgar para el agarre tipo
punta.
Se debe indicar que esta trayectoria se realiza considerando que todos los motores
de paso se mueven al mismo tiempo.
A continuacin se muestran en las figuras 4.21 y 4.22 una simulacin realizada en
Matlab de la posicin angular en radianes del eje de cada uno de los motores de paso
que componen la mano. Para esta simulacin se toma en cuenta que los dedos de la
mano pasan de la posicin inicial a la posicin final de agarre de tipo punta en 2
segundos; este tiempo de simulacin puede variar dependiendo de la velocidad con la
que se quiera realizar el agarre y considerando que se puede controlar la velocidad de
paso de los motores
83
Figura 4.21 Posicin de cada una de las articulaciones en radianes para realizar el
movimiento de agarre de punta del dedo ndice.
Figura 4.22 Posicin de cada una de las articulaciones en radianes para realizar el
movimiento de agarre de punta del dedo pulgar.
84
85
86
CONCLUSIONES
Se realiz el diseo de una mano mecnica de dos dedos que pueden realizar
el agarre de tipo punta partiendo de los movimientos de flexin y extensin de
sus dedos y puede ser usado como un efector final de un robot.
87
RECOMENDACIONES
88
REVISIN BIBLIOGRFICA
89
90
Disponible:
91