Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
FACULTAD DE MECÁNICA
ESCUELA DE INGENIERIA MECÁNICA
TRABAJO DE INVESTIGACIÓN:
TIPO INVESTIGACIÓN
Riobamba – Ecuador
2019
i
©2019, GRUPO 3 (ANALISIS CINEMATICO – TORNILLOS INFINITESIMALES)
Se autoriza la reproducción total o parcial, con fines académicos, por cualquier medio o
procedimiento, incluyendo la cta bibliográfica del documento, siempre y cuando se reconozca el
Derecho de Autor,
ii
Nosotros, DAVID QUEVEDO y KAREN REMACHE declaramos que el trabajo de
investigación que presentamos es original y basado en el proceso de investigación y/o adaptación
tecnológica establecido en la Facultad de Mecánica de la Escuela Superior Politécnica de
Chimborazo. En tal virtud, los fundamentos teórico- científicos y los resultados son de exclusiva
responsabilidad de los autores. El patrimonio intelectual le pertenece a la Escuela Superior
Politécnica de Chimborazo.
___________________________________ ___________________________________
DAVID GERARDO QUEVEDO LOPEZ KAREN FERNANDA REMACHE CATAGÑA
060501765-6 0604511782
iii
TABLA DE CONTENIDO
Páginas
RESUMEN
SUMMARY
INTRODUCCIÓN 2
CAPÍTULO I
CAPÍTULO II
iv
2.3.1. Criterios de Singularidad .................................................................................. 13
CAPÍTULO III
CONCLUSIONES
RECOMENDACIONES
BIBLIOGRAFIA
v
INDICE DE FIGURAS
Figura 1-1. Diagrama abstracto de un robot manipulador de n g.d.l........... Error! Bookmark not
defined.
Figura 2-1. Manipulador de 3 g.d.l, los ejes zi así como las coordenadas articulares. ................. 7
Figura 3-1. Partes del dedo índice humano ................................................................................. 13
Figura 4-1 Manipulador de dos grados de libertad accionado por tres actuadores. (b) Modelo
de una articulación simple accionada por dos actuadores. .......................................................... 14
Figura 5-1. Representación en forma de revolutas las articulaciones del dedo. ........................ 14
INDICE DE TABLAS
vi
RESUMEN
vii
SUMMARY
The present investigation consists of the kinematic analysis of a robotic finger using the
infinitesimal screws method. Each applied method is supported by an analysis using
ADAMS and MATLAB, the software applied in the modeling of the finger was
SOLIDWORKS, with which things were facilitated when performing the body's motion.
The theory applied to validate the results by means of screws comprises the use of the
analysis of positions by means of a diagram of loops, then the equations obtained in the
analysis of screws and in the analysis of loops in the MATLAB software will be
graphed. The final effect of the analysis is to carry out a prototype of the rehabilitator
and to be able to compare the trajectory, velocity and acceleration results with those of
the finger, so that, by means of a small rotational actuator, the links that are part of the
Rehabilitating body and this in turn move the human finger together so that little by
little it returns to its state of natural movement. The modeling used in the present
investigation was taken from a previously done research, however, the explanation of
why the analysis is done in two parts of 4-bar mechanism and the respective kinematic
curves in the different programs were made with basic knowledge of mechanisms.
INTRODUCCIÓN
Se dice que la biomecánica estudia las estructuras mecánicas que existen en los seres vivos,
principalmente en los seres humanos. Por tanto, es una rama tecnológica que tiene como objetivo
analizar desde el punto de vista ingenieril a los mecanismos que estén presentes en los seres
vivos. La biomecánica tiene una pequeña hipótesis pero que facilita el análisis y adaptación de
las prótesis, el sistema óseo se adapta a las leyes newtonianas. (Borges, 2019)
Los tornillos infinitesimales sin duda son una herramienta muy útil en la dinámica de máquinas,
su principal ventaja se ve presente cuando se quiere hacer el análisis cinemático de cuerpos en
3D, el planteamiento de las matrices es relativamente fácil en comparación con el estudio
cinemático que ocupan otros métodos. (Prada, 2013)
Por su parte el estudio dinámico de un mecanismo rehabilitador tal es el caso de un dedo por el
método de Euler Lagrange es un poco complejo en comparación con otros métodos ya que
involucra análisis de energías cinética y potencial.
El análisis desde el punto de vista mecánico de dedo robótico se puede efectuar atendiendo
exclusivamente a sus movimientos (estudio cinemático) o atendiendo además a las fuerzas y
momentos que actúan sobre sus partes (estudio dinámico) debidas a los elementos actuadores y
a la carga transportada por el elemento terminal. (Prada, 2013)
El diseño mecánico es un caso particular de sistemas multicuerpo en los que existe la posibilidad
de movimiento relativo de sólido rígido entre sus elementos. El análisis empieza por la selección
de la cadena cinemática más idónea. En el análisis cinemático se presenta pueden distinguir a
su vez dos grandes grupos de problemas, de un lado los lineales: velocidades, aceleraciones,
sobre aceleraciones y de otro los no lineales: fundamentalmente los problemas de posición. A
su vez estos últimos pueden ser de posición inicial, posiciones sucesivas, posición deformada y
posición de equilibrio estático, así como los problemas directo e inverso en el caso de
mecanismos de cadena abierta.
1. MARCO TEÓRICO
Dentro de la biomecánica la screw theory es una herramienta muy importante y poderosa ya que
permite realizar un análisis cinemático de los cuerpos rígidos. Los screws son vectores y estos
a su vez consta de 2 vectores tridimensionales.
La screw theory fue desarrollada por Hunt (2004), Tsai (1999) y Chasles (1830) y establece que
cualquier desplazamiento de un cuerpo rígido puede realizarse mediante una rotación alrededor
de un eje combinado con una traslación paralela a ese eje". El movimiento completo se llama
giro y está representado por $. (Borges, 2019)
El estudio de la teoría de tornillos empieza con el análisis de los sistemas mecánicos abiertos y
cerrados, para entender lo que es una cadena cinemática abierta podemos hacernos la idea que
es un mecanismo en donde el eslabón fijo es la bancada y los demás eslabones no se van a cerrar
es decir no va a haber un eslabón que una el final con el inicio.
Una manera fácil para la aplicación de tornillos es tener muy en cuenta que se lo resuelve por
lazos, es decir, se recomienda de apoyo a apoyo (sistema mecánico cerrado), y si es un sistema
mecánico abierto nos suponemos un nuevo eslabón que se conecta al eslabón motriz,
convirtiéndose así en un sistema cerrado.
Otro elemento importante que se considera en el análisis de tornillos infinitesimales son los
pares cinemáticos, los cuales son los que permiten el movimiento de un elemento respecto a
otro, restringiendo los grados de movimiento respecto al grupo que pertenezca. Es decir, si
suponemos una pareja de elementos, pertenecientes a diferentes eslabones, mantenidos
permanentemente en contacto y de manera que existe movimiento relativo entre ellos, recibe el
nombre de par cinemático. (Prada, 2013)
Los screws vienen dado ya sea en un par prismático o de revoluta, cada uno tiene una
característica. En general la ecuación de tornillo es la siguiente:
𝑠̂
$=[ ] (1)
𝑠⃗⃗⃗⃗𝑂
Es importante notar las diferencias entre los tornillos infinitesimales asociados a los pares de
revoluta y a los pares primáticos.
Las expresiones de los tornillos infinitesimales mostrados en las ecuaciones anteriores
constituyen un caso particular de una formulación mas general para un par cinemático de
tornillo, del cual los pares de revoluta y prismáticos constituyen casos particulares.
𝑠𝑂 = 𝑠̂ × ⃗⃗⃗⃗⃗⃗⃗⃗
⃗⃗⃗⃗ 𝑟𝑂⁄ + ℎ𝑠̂ (2)
𝑃
donde 𝑟𝑂/𝑃 es el vector de posición del punto de interés, O, respecto a un punto, P,a lo largo
del eje de rotación del par de revoluta o de tornillo, y h es el paso del par de tornillo, ℎ = 0 si
el par es de revoluta.
2. Si el par es prismático
𝑠𝑂 = 𝑠̂
⃗⃗⃗⃗ (3)
donde 𝑠̂ es un vector unitario en la dirección del movimiento de la traslación asociada al par
prismático.
Figura 1-1. Manipulador de 3 g.d.l, los ejes zi así como las coordenadas articulares.
Fuente: (Robótica Automática, pp. 65-68,2003)
Las posiciones articulares correspondientes a cada articulación del robot, que se miden por
medio de sensores colocados en los accionadores localizados generalmente justo en las
articulaciones, se agrupan para propósitos de análisis en el vector de posiciones articulares
q. En consecuencias, para un robot con n articulaciones, es decir, de n g.d.l, el vector de
posiciones articulares q tendrá n elementos: (Robótica Automática, pp. 65-68,2003)
𝑞1
𝑞2
𝑞={⋮ } (1)
𝑞𝑛
Por otro lado, también resulta de gran interés, sobre todo desde un punto de vista práctico, la
determinación de la posición y orientación del dispositivo terminal del robot, puesto que el
dispositivo terminal realiza la tarea recomendada al robot, tal como abrir cerrar una garra, aplicar
una soldadura, etc. Dicha posición y orientación se expresa en términos del marco de referencia
coordenado cartesiano (x y z) colocado en la base del robot, así como eventualmente en
terminaos de los llamados ángulos de Euler. Dichas coordenadas y ángulos son agrupados en el
vector x de posiciones cartesianas: (Robótica Automática, pp. 65-68,2003)
𝑥1
𝑥2
𝑥={ ⋮ } (2)
𝑥𝑚
Donde m< n. en el escenario donde el extremo final del robot puede tomar cualquier posición
y orientación en el espacio euclidiano de dimensión 3, se tendrá m=6. Por otra parte, si el
movimiento del robot realiza en un plano (dimensión 2) y solo interesa la posición de su
extremo final m=2, si además, se está interesado en su orientación en el plano, entonces m=3.
El modelo cinemático directo de un robot, describe la relación entre la posición articular q y
la posición y orientación x del dispositivo terminal del robot. En otras palabras, el modelo
cinemático directo de un robot es una relación de la forma:
𝑥 = 𝑓(𝑞) (3)
𝑥 = 𝑓 −1 (𝑥) (4)
A diferencia del modelo cinemático directo, la determinación del modelo cinemático inverso
𝑥 = 𝑓 −1 (𝑥) puede resultar complicado, pudiendo tener, inclusive, ninguna o múltiples
soluciones. (Robótica Automática, pp. 65-68,2003)
El modelo dinámico de un robot consiste en una ecuación diferencial (ordinaria) vectorial en
las posiciones, ya sean articulaciones q o cartesianas x, generalmente de segundo orden,
pudiéndose expresar como:
𝑓(𝑞, 𝑞̇ , 𝑞̈ , 𝑟) = 0 (5)
𝑓(𝑥, 𝑥̇ , 𝑥̈ , 𝑟) = 0 (6)
Este método clásico de resolución de este tipo de problemas, se basa en la formación de una
función objetivo ampliada ℒ, suma de la función objetivo primitiva más el producto de cada
una de las restricciones por unas nuevas auxiliares, que son los multiplicadores de Lagrange
𝜆𝑖. (Zienkiewicz, pp. 80,1981)
1
ℒ({𝑥}, {𝜆}) = 2 ∑𝑟𝑖=1 𝔰𝑖(𝑑𝑖({𝑥}) − 𝐷𝑖)2 − {𝐹}𝑇 {𝑥} + ∑𝑏𝑖=1 𝜆𝑖(𝑙𝑖({𝑥}) − 𝐿𝑖). (7)
𝜕ℒ
{∇𝑥 ℒ} = { } = {0} (8)
𝜕{𝑥}
Donde
𝜕ℒ 𝜕𝑑𝑖({𝑥}) 𝜕𝑙𝑖({𝑥})
{𝜕{𝑥}} = ∑𝑟𝑖=1 𝔰𝑖(𝑑𝑖({𝑥}) − 𝐷𝑖). { 𝜕{𝑥}
}− {𝐹}. + ∑𝑏𝑖=1 𝜆𝑖 {
𝜕{𝑥}
} (9)
− cos 𝜃𝑖
− sin 𝜃𝑖
{ℎ}𝑖 = { } (10)
cos 𝜃𝑖
sin 𝜃𝑖
Siendo 𝜃𝑖 el ángulo de posición del elemento barra i, supongamos por ejemplo entre los
nudos 1(𝑥11 , 𝑥21 ) y 2(𝑥21 , 𝑥22 ), cuya longitud es 𝑙𝑖
𝜕𝑙𝑖({𝑥})
{ 𝜕{𝑥}
} = {ℎ̅}𝑖 (12)
Siendo {ℎ̅}𝑖 , el vector {ℎ}𝑖 expandido a la dimensión del modelo completo. Algo análogo
sucede para di. En consecuencia:
𝜕ℒ
{𝜕{𝑥}} = ∑𝑟𝑖=1 𝔰𝑖(𝑑𝑖({𝑥}) − 𝐷𝑖). {ℎ̅}𝑖 − {𝐹}. + ∑𝑏𝑖=1 𝜆𝑖{ℎ̅}𝑖 (13)
𝜕ℒ({𝑥},{𝜆})
{ }
{ 𝜕{𝑥} } = {0} (14)
{𝑐({𝑥})}
Siendo
𝐶1 ({𝑥})
{𝑐({𝑥})} = {𝐶2 ({𝑥})} (15)
⋮
𝐶𝑏 ({𝑥}
{𝑥}
{𝑞} = { } (16)
{𝜆}
Entonces se verifica
𝜕ℒ
𝜕{ }
𝜕ℒ 𝜕ℒ 𝜕{𝑥} .
{𝜕{𝑥}} ≈ {𝜕{𝑥}} +[ 𝜕{𝑞}
] ({𝑞}𝑘+1 − {𝑞}𝑘 ) (17)
𝑘+1 𝑘
𝑘
Y además
𝜕{𝑐}
{𝑐}𝑘+1 ≈ {𝑐}𝑘 + [ ] ({𝑞}𝑘+1 − {𝑞}𝑘 ) (18)
𝜕{𝑞} 𝑘
Con lo que el sistema de ecuaciones no lineales (14) se aproxima en cada iteración k por el
sistema lineal siguiente
𝜕ℒ
𝜕{ }
𝜕{𝑥} .
[ 𝜕{𝑞}
] {𝑥} {𝑥} −{ }
𝜕ℒ
. ({ } − { } ) = { 𝜕{𝑥} . } (19)
𝜕{𝑐}
{𝜆} 𝑘+1 {𝜆} 𝑘 −{𝑐}
[𝜕{𝑞}] . 𝑘
[ . ]𝑘
Desarrollando la matriz del sistema anterior
𝜕ℒ
𝜕{ } 𝜕2 ℒ 𝜕2 ℒ
𝜕{𝑥} .
[ [𝜕{𝑥}2. ]
] [ .
]
𝜕{𝑞} 2𝑛𝑥2𝑛 𝜕{𝑥}𝜕{𝜆} 2𝑛𝑥𝑏
[𝐴] = . = [ 𝜕{𝑐} 𝜕{𝑐}
] (20)
𝜕{𝑐} [𝜕{𝑥}] [𝜕{𝜆}]
[ ] 𝑏𝑥2𝑛 𝑏𝑥𝑏
[ 𝜕{𝑞} . ] [ ]
𝑇
{ℎ̅}1
̅ 𝑇
[𝜕{𝑥}] = [𝜕{𝑥}] {ℎ}2
𝜕{𝑐} 𝜕{𝑙}
(21)
⋮
𝑇
{{ℎ̅}𝑏 }
𝜕{𝑐}
[𝜕{𝜆}] = [0] (22)
.
2
𝜕 ℒ. 𝜕{𝑐} 𝑇
[𝜕{𝑥}𝜕{𝜆} ] = [{ℎ̅}1 {ℎ̅}2 … {ℎ̅}𝑏 ] = [𝜕{𝑥}] (23)
. .
𝜕2 ℒ
[𝜕{𝑥}2. ] 𝜕{𝑐} 𝑇
2𝑛𝑥2𝑛 [𝜕{𝑥}]
[𝐴] = [ 𝜕{𝑐} 2𝑛𝑥𝑏 ] (24)
[𝜕{𝑥}] [0]𝑏𝑥𝑏
[ 𝑏𝑥2𝑛 ]
2 ̅ . ̅
𝜕 ℒ 𝜕{𝑐} 𝜕{ℎ } 𝜕{ℎ }
[𝜕{𝑥}2. ] = [∇2𝑥 ℒ] = ∑𝑟𝑖=1 𝔰𝑖 ({𝜕{𝑥}} + 𝛿𝐷𝑖 [ 𝜕{𝑥}𝑖]) {ℎ̅}𝑖 + ∑𝑏𝑖=1 𝜆𝑖{ℎ̅}𝑖 [ 𝜕{𝑥}𝑖] (25)
𝑇
{ℎ̅}𝑖 {ℎ̅}𝑖 = [𝑔̅ ]𝑖 (27)
Por otro lado, si se deriva dos veces la longitud 𝑑𝑖 respecto de {𝑥}. Teniendo en cuenta, se
obtiene
.
𝜕2 ℒ 𝛿𝐷𝑖 𝜆𝑖
[𝜕{𝑥}2. ] = ∑𝑟𝑖=1 𝔰𝑖 ([𝑔̅ ]𝑖 + 𝑑𝑖
([𝑡̅]𝑖 − [𝑔̅ ]𝑖 )) + ∑𝑏𝑖=1
𝑙𝑖
([𝑡̅]𝑖 − [𝑔̅ ]𝑖 ) (29)
𝜕2 ℒ 𝔰𝑖 . 𝜆𝑖
[𝜕{𝑥}2. ] = ∑𝑟𝑖=1 𝑑𝑖 ((𝐷𝑖[𝑔̅ ]𝑖 + 𝛿𝐷𝑖([𝑡̅]𝑖 )) + ∑𝑏𝑖=1 𝑙𝑖 ([𝑡̅]𝑖 − [𝑔̅ ]𝑖 )) (30)
En definitiva, si se calculan los valores de las matrices (30) y (24), es decir de la matriz (23) y
los vectores (12) y (14), para una iteración k se podrá resolver el sistema de ecuaciones
lineales (18) y obtener así el valor de
{𝑥} {𝑥} {𝑥} {𝑥}
{𝛿𝑞 }𝑘 = { } − { } ⇒ {𝑞}𝑘+1 = { } = { } + {𝛿𝑞 }𝑘 (31)
{𝜆} 𝑘+1 {𝜆} 𝑘 {𝜆} 𝑘+1 {𝜆} 𝑘
En la mano humana, cada dedo presenta un hueso metacarpiano y falanges proximal, media y distal. El
pulgar solamente presenta las falanges proximal y distal. El dedo humano este compuesto de tres
principales articulaciones; articulación metacarpo falángica (MCP): que une la falange metacarpiana y la
proximal de un dedo o pulgar; articulación interfalángica proximal (PIP): localizada entre las falanges
media y proximal del dedo; articulación interfalángica distal (DIP): ubicada entre las falanges media y
distal del dedo. La Figura 1 muestra un esquema del dedo índice y sus falanges y tendones flexores. (Avilés,
pp.49-58,2007)
Realizado: investigadores
En los tendones enrutados en forma abierta, un extremo del tendón está fijo a la polea conducida
y el otro extremo es tirado mediante un actuador lineal o se encuentra asociado a una polea
conductora. En estos mecanismos el brazo lo constituye el eslabón de la cadena cinemática, el
cual mantiene constante la distancia entre los ejes zi y zj. En la figura a continuación se describe
funcionalmente el enrutamiento de tendones para el dedo antropomorfo.
Figura 3-1 Manipulador de dos grados de libertad accionado por tres actuadores. (b) Modelo
de una articulación simple accionada por dos actuadores.
Fuente: (Avilés, pp.49-58,2007)
Este dedo cuenta con 4 grados de libertad, el primer grado de libertad está dado por la abducción
y aducción presentes la falange proximal y los otros tres por la flexión y extensión de las falanges
proximal, media y distal. Por facilidad de construcción e implementación se restringe el primero
y último grado de libertad, obteniendo dos grados de libertad por cada dedo. Este diseño
contempla tres dedos, dos de ellos opuestos al tercero, dando como resultado un gripper de 6
grados de libertad.
2. EJERCICIOS DE APLICACIÓN
3. CONCLUSIONES
Las prótesis de manos son hoy en día una de las más importantes ya que son extensiones
que pueden reemplazar al miembro faltante obteniendo la misma función a partir de
cierta inteligencia que puede estar formada por diferentes componentes y sistemas de
control, por lo que es de vital ayuda para personas que sufren amputaciones, ya que un
gran porcentaje no usa ningún tipo de prótesis.
La tecnología de las prótesis de mano robótica tiene un costo relativamente alto por lo
que la mayoría de estas solo se presentan en prototipos. Se espera que las desarrolladas
actualmente sirvan de ayuda en el futuro para el desarrollo de prótesis que puedan ser
fácilmente comercializadas en el mercado al alcance de personas que las necesitan.
4. RECOMENDACIONES
Una de las recomendaciones más importantes seria que el docente imparta unas breves
clases acerca del tema ya que es un tema muy complejo y del cual no se posee mucha
información.
Se recomienda antes de realizar el diseño electrónico, tener desarrollado el diseño
funcional y establecido las características deseadas, para evitar diseñar nuevamente en
caso de haber pasado por alto algún detalle
El ensamble de los sensores y circuitos debe ser realizado lo más exacto posible, debido
a la cantidad de espacio disponible y la debida colocación y sujeta al chasis por el
movimiento que puede provocar al momento de ejecutarse
El tiempo de duración de la batería es un factor muy importante que debe ser tomado
en cuenta, ya que según pruebas realizadas la duración de la batería es muy baja, lo cual
disminuye el rendimiento del robot, en especial si lo queremos para altas velocidades
GLOSARIO
BIBLIOGRAFIA
BAYO, Eduardo; DE JALÓN, Javier García. Kinematic and dynamic simulation of multibody
systems: the real-time challenge. Springer, 1994.
AVILÉS, R.; AJURIA, M. B.; DE JALÓN, J. García. A fairly general method for optimum
synthesis of planar mechanisms. Mechanism and Machine Theory, 1985, vol. 20, no 4, p. 321-
328.
AVILÉS, R., et al. An energy-based general method for the optimum synthesis of
mechanisms. Journal of Mechanical Design, 1994, vol. 116, no 1, p. 127-136.
AVILÉS, Rafael, et al. A procedure for the optimal synthesis of planar mechanisms based on
non‐linear position problems. International journal for numerical methods in engineering, 1997,
vol. 40, no 8, p. 1505-1524.
AVILÉS, Rafael, et al. A procedure based on finite elements for the solution of nonlinear
problems in the kinematic analysis of mechanisms. Finite Elements in Analysis and Design,
1996, vol. 22, no 4, p. 305-327.
AVILÉS, Rafael; AJURIA, Goizalde; BILBAO, Armando. Métodos para la resolución del
problema no lineal de equilibrio estático en sistemas multicuerpo. Revista internacional de
métodos numéricos para cálculo y diseño en ingeniería, 1998, vol. 14, no 2, p. 203-224.
AVILES, Óscar F.; SIMANCA, Pedro L.; NIÑO, Paola. Diseño y construcción de un dedo para
grippers robótico. Revista Colombiana de Rehabilitación, 2007, vol. 6, no 1, p. 49-58.
ANEXOS