Documentos de Académico
Documentos de Profesional
Documentos de Cultura
UNIVERSIDAD
NACIONAL DE INFORME
INGENIERÍA
FACULTAD DE INGENIERÍA
N° 01
MECÁNICA
ACULTAD DE INGENIERÍA MECÁNICA
TEMAS:
CINEMATICA INVERSADOCENTE
CINEMATICA DIRECTAFREEDY SOTELO
DISEÑO INTEGRANTES
SIMULACION
CONISLLA CONTRERAS, Oskar Steven
RAU ESPINOZA, Ulises Piero
SALAZAR ARÉVALO, Renzo Sebastián
2017 – II
SARMIENTO DÍAZ, Fernando Gabriel
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
1) CINEMATICA DIRECTA
El problema cinemático directo consiste en determinar cuál es la posición y orientación del
extremo final del robot, con respecto a un sistema de coordenadas que se toma como
referencia, conocidos los valores de las articulaciones y los parámetros geométricos de los
elementos del robot.
En general, un robot de n grados de libertad está formado por n eslabones unidos por n
articulaciones, de forma que cada par articulación - eslabón constituye un grado de libertad.
1
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
Para describir la relación que existe entre dos sistemas de referencia asociados a eslabones,
se utiliza la representación Denavit - Hartenberg (D-H). Denavit y Hartenberg propusieron
en 1955 un método matricial que permite establecer de manera sistemática un sistema de
coordenadas {Si} ligado a cada eslabón i de una cadena articulada. Además, la
representación D-H permite pasar de un sistema de coordenadas a otro mediante 4
transformaciones básicas que dependen exclusivamente de las características geométricas
del eslabón.
2
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
Parámetros DENAVIT-HARTENBERG
Θ d a α
1 θ1 l1 0 π/2
2 θ2 l2 l3 0
3
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
c1 0 s1 0
s 0 c1 0
T1 A1 1
0 1 0 l1
0 0 0 1
c2 s2 0 l3c2
s c2 0 l3 s2
A2 2
0 0 1 l2
0 0 0 1
4
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
2) CINEMATICA INVERSA
El problema cinemático inverso consiste en encontrar los valores que deben adoptar las
coordenadas articulares del robot q = [q1, q2, . . . , qn] para que su extremo se posicione y
oriente según una determinada localización espacial. Al contrario que el problema
cinemático directo, el cálculo de la cinemática inversa no es sencilla ya que consiste en la
resolución de una serie de ecuaciones fuertemente dependiente de la configuración del
robot, además de existir diferentes n − uplas q = [q1, q2, . . . , qn] que resuelven el problema.
5
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
Para poder conseguir esta relación suele ser habitual emplear métodos geométricos, que
consisten en la utilización de las relaciones trigonométricas y la resolución de los triángulos
formados por los elementos y articulaciones del robot. La mayoría de los robots suelen
tener cadenas cinemáticas relativamente sencillas, y los tres primeros gdl, que posicionan
al robot en el espacio, suelen tener una estructura planar. Esta condición facilita la
resolución de la n − upla. Además, los tres últimos grados de libertad suelen usarse para la
orientación de la herramienta, lo cual permite la resolución desacoplada (desacoplo
cinemático) de la posición del extremo delrobot y de la orientación de la herramienta. Como
alternativa para resolver el mismo problema se puede recurrir a manipular directamente
las ecuaciones correspondientes al problema cinemático directo. Es decir, a partir de la
relación entre la matriz de transformación y las ecuaciones en función de las coordenadas
articulares q = [q1, q2, . . . , qn].
6
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
Calculo de ϴ2:
De la anterior figura
z l1
sen 2 D
l3
cos 2 1 D 2
2 a tan 2( D, 1 D 2 )
Calculo de ϴ1:
Se calcula el ángulo (ángulo entre eje x y eje y) de la siguiente manera:
y
tan
x
y
tan 1
x
a tan 2 y, x
Mientras el ángulo :
l3 cos( 2 )
tan
l2
a tan 2(l3 cos( 2 ), l2 )
1
1 a tan 2( yc , xc ) a tan 2(l3 cos( 2 ), l2 )
7
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
3) DISEÑO
El material a usar para los links será el acrílico (6cm de espesor, 1180 kg/m3). Se usará este
material ya que tiene densidad relativamente baja y bajo costo.
Las medidas aproximadas para el tamaño del brazo son de 10 cm x 3cm el primer link y
de 5cm x 3cm para el segundo link, con todos estos datos podemos hacer los cálculos para
calcular el torque mínimo requerido para los motores a usar.
1 1 2
I ml mr
2
12 4
1
I m( a 2 b 2 )
12
8
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
1
I MR 2
2
9
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
MOTORES SELECCIONADOS
Mediante cálculos anteriormente realizados, se determinó que el torque del primer
motor debe ser mayor o igual a 3Kg-cm. Este motor tiene que poseer un torque
relativamente alto con respecto al segundo ya que debe soportar la estructura de todo
el brazo incluyendo el segundo motor.
El segundo motor no requiere un torque alto debido a que solo soportara mover el link
2. Gracias a los cálculos anteriores se determinó que este motor debe resisitir un torque
mínimo de 0.5Kg-cm.
Para poder controlar la posición del brazo de 2GDL en todo momento es necesario que
los motores tengan encoder de 2 canales. También se requerirá que las RPM que
entregaran las cajas reductoras de los motores sean bajas ya que no necesitamos
demasiada velocidad, pero si un torque necesario.
10
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
PRIMER MOTOR
Este motor cuenta con un reductor de velocidad y encoder. Presenta las siguientes
características: trabaja a 6v, posee un torque de 6.8 Kg-cm y 78RPM. Además, presenta
un encoder de efecto Hall, el cual tiene una resolución de 48 cuentas por revolución.
También se muestra las especificaciones brindadas por el fabricante.
11
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
SEGUNDO MOTOR
De acuerdo a las especificaciones necesarias en nuestro diseño del robot de 2GDL el motor más
adecuado tiene como nombre: 50:1 Micro Metal Gearmotor MP 6V with 48 CPR Encoder. Este
motor cuenta con reductor de velocidad y encoder, presenta las siguientes características:
trabaja a 6v, posee un torque de 1.0 Kg-cm y 420 RPM. Además, presenta un encoder de efecto
Hall, el cual tiene una resolución de 48 cuentas por revolución. También se muestra las
especificaciones brindadas por el fabricante.
12
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
13
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
SIMULACION
14
Universidad Nacional de Ingeniería Facultad de Ingeniería Mecánica
15