Documentos de Académico
Documentos de Profesional
Documentos de Cultura
UNIVERSIDAD NACIONAL DE
INGENIERÍA
FACULTAD DE INGENIERÍA MECÁNICA
UNIVERSIDAD NACIONAL DE INGENIERÍA
FACULTAD DE INGENIERÍA MECÁNICA
INFORME Nº1
PROFESOR DE PRÁCTICA:
ING. CALLE FLORES IVÁN ARTURO
SECCIÓN:
A
INTEGRANTES: CÓDIGO:
MOSQUERA VILLANUEVA, ADRIANA AURORA 20154068I
SOTELO ASTIYAURE, JOSÉ VALERIO 20144057D
ÍNDICE
1. OBJETIVOS ................................................................................................................................. 4
1.1. OBJETIVO GENERAL ............................................................................................................ 4
1.2. OBJETIVOS ESPECIFICOS ..................................................................................................... 4
2. DISEÑO MECÁNICO ................................................................................................................... 4
2.1. Composición del brazo robótico: ....................................................................................... 5
2.2. Planos de piezas del brazo robótico:.................................................................................. 6
3. CINEMÁTICA DIRECTA ............................................................................................................. 11
3.1. ASIGNACION DE SISTEMAS COORDENADOS SEGÚN DENAVIT-HARTENBERG ................. 11
3.2. PARÁMETROS DENAVIT-HARTENBERG ............................................................................ 12
3.3. MATRICES DE TRANSFORMACIÓN ................................................................................... 14
4. CINEMÁTICA INVERSA ............................................................................................................. 15
5. DISEÑO ELECTRÓNICO............................................................................................................. 18
5.1. MICROCONTROLADOR ..................................................................................................... 18
5.1.1. TEENSY 3.5................................................................................................................. 18
5.1.2. ARDUINO UNO R3 ..................................................................................................... 19
5.2. DRIVER DE POTENCIA (PUENTE H) ................................................................................... 20
5.2.1. VNH5019 ................................................................................................................... 20
5.2.2. L298N ........................................................................................................................ 21
5.3. OPCIONES DE COMPONETES ELECTRÓNICOS .................................................................. 22
5.3.1. OPCION 1 ................................................................................................................... 22
5.3.2. OPCION 2 ................................................................................................................... 24
6. ESPECIFICACIONES DE MOTORES ............................................................................................ 24
7. Bibliografía .............................................................................................................................. 26
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
1. OBJETIVOS
1.1. OBJETIVO GENERAL
Diseño de un manipulador robótico de 2GDL
2. DISEÑO MECÁNICO
Para realizar el diseño mecánico, como primer paso se eligió el tipo de juntas del robot
de 2GDL que en nuestro caso es de dos juntas rotacionales, como segundo paso se
tomó en cuenta dos motores DC con reducción y enconder que ya teníamos y el diseño
se basó tomando en cuenta sus dimensiones.
4
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
5
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
N.º DE
N.º DE PIEZA DESCRIPCIÓN CANTIDAD
ELEMENTO
Figura 3. Base_01
6
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Figura 5. CUBO_MONTAJE_ALUMINIO
7
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Figura 6. CUBIERTA_LATERAL_01
8
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Figura 8. CUBIERTA_LATERAL_02.
9
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Figura 9. BASE_02.
10
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
3. CINEMÁTICA DIRECTA
3.1. ASIGNACION DE SISTEMAS COORDENADOS SEGÚN DENAVIT-
HARTENBERG
Parámetros 1:
11
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
LINK 𝜽𝒊 𝒅𝒊 𝒂𝒊 𝜶𝒊
𝜋
1 𝑞1∗ 𝑑1 0
2
2 𝑞2∗ 0 𝑎2 0
12
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
13
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
𝑐1 0 𝑆1 0 𝑐1 0 𝑆1 0
𝑆 0 −𝐶1 0 𝑆1 0 −𝐶1 0
𝐴01 = [ 1 ]→ [ ]
0 1 0 𝑑1 0 1 0 37.90
0 0 0 1 0 0 0 1
𝑐1 0 𝑆1 0 𝑐1 0 𝑆1 0
𝑆 0 −𝐶1 0 𝑆1 0 −𝐶1 0
𝑇01 = 𝐴01 = [ 1 ]→ [ ]
0 1 0 𝑑1 0 1 0 37.90
0 0 0 1 0 0 0 1
𝐶1 𝐶2 −𝐶1 𝑆2 𝑆1 𝑎2 𝐶1 𝐶2
𝑆 𝐶 −𝑆 𝑆 −𝐶 𝑎2 𝑆1 𝐶2
𝑇02 = 𝐴01 𝐴12 = [ 1 2 1 2 1
]
𝑆 2 𝐶2 0 𝑎2 𝑆2 + 𝑑1
0 0 0 1
𝐶1 𝐶2 −𝐶1 𝑆2 𝑆1 148.77𝐶1 𝐶2
𝑆 𝐶 −𝑆1 𝑆2 −𝐶1 148.77𝑆1 𝐶2
→[ 1 2 ]
𝑆 2 𝐶2 0 148.77𝑆2 + 37.9
0 0 0 1
14
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
4. CINEMÁTICA INVERSA
Se procedió por el método gráfico, y teniendo en cuenta que se desea alcanzar en el
efector final la posición 𝑃 = [ 𝑋𝐶 𝑌𝐶 𝑍𝐶 ], se encuentra solo una posible solución para los
ángulos 𝑞1 y 𝑞2 .
(XC,YC,ZC)0
15
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Cálculo de ϴ1:
De la figura anterior
𝜽𝟏 = 𝒂 𝒕𝒂𝒏 𝟐 (𝒀𝑪 , 𝑿𝑪 )
𝑞1 = [ 𝜃1 ]
Consideramos:
16
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
=r
Cálculo de ϴ2:
Consideramos: 𝑠 = 𝑍𝐶 − 𝐿1
De la figura anterior
𝑍𝐶 − 𝐿1 𝑠
𝑠𝑒𝑛𝜃2 = =
𝐿2 𝐿2
𝑟
𝑐𝑜𝑠 𝜃2 =
𝐿2
𝜽𝟐 = 𝒂 𝒕𝒂𝒏 𝟐 (𝒔, 𝒓)
𝑞2 = [ 𝜃2 ]
17
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
5. DISEÑO ELECTRÓNICO
5.1. MICROCONTROLADOR
5.1.1. TEENSY 3.5
Especificaciones generales [1]:
18
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Microcontrolador ATmega328P
Tensión de
5V
funcionamiento
Voltaje de entrada
7-12V
(recomendado)
Voltaje de entrada
6-20V
(límite)
Pernos digitales de E /
14 (de los cuales 6 proporcionan salida PWM)
S
PWM Digital I / O Pins 6
Clavijas de entrada
6
analógica
Corriente DC por Pin de
20 mA
E/S
Corriente DC para 3.3V
50 mA
Pin
32 KB (ATmega328P) de los cuales 0.5 KB utilizados
Memoria flash
por el cargador de arranque
SRAM 2 KB (ATmega328P)
EEPROM 1 KB (ATmega328P)
Velocidad de reloj 16 MHz
LED_BUILTIN 13
19
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Longitud 68.6 mm
Anchura 53.4 mm
Peso 25 g
Tabla 6. Especificaciones generales del Pololu Dual VNH5019 Motor Driver [3].
1
No se recomienda su uso con baterías de 24V.
2
A -16 V. La conexión de suministros a más de 16 V en sentido inverso puede dañar el motor.
20
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Tamaño: 2.56 "x 2.02" x 0.38 " (65.02 mm x 51.31 mm x 9.65 mm)3
Peso: 18 g
5.2.2. L298N
3
Sin hardware incluido.
4
Valor tomado del Datasheet [5].
5
Se reportan voltajes máximos experimentales de 35V [7]
6
A 1A se empienzan a presenter problemas de temperature.
7
Se reportan frecuencias máximas de 20kHz [6]
21
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Tamaño: 43 mm x 43 mm x 27 mm8
PRECIO
CANTIDAD MATERIAL OBSERVACION PRECIO
UNITARIO
1 Teensy 3.5 Microcontrolador S/92.00 S/92.00
1 Dual VNH5019 Pololu Driver de Potencia S/164.84 S/164.84
1 Funte 12 VDC S/50.00 S/50.00
1 LM2592 STEP DOWN DC-DC (12V-5V) S/8.00 S/8.00
SUBTOTAL (ELECTRONICA) S/314.84
8
Sin hardware incluido.
22
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
23
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
5.3.2. OPCION 2
Tabla 11. Componentes electrónicos (Opción 2)
PRECIO
CANTIDAD MATERIAL OBSERVACION PRECIO
UNITARIO
1 ARDUINO UNO R3 Microcontrolador S/30.00 S/30.00
1 L298N Driver de Potencia S/12.00 S/12.00
1 Funte 12 VDC - S/50.00 S/50.00
1 LM2592 STEP DOWN DC-DC (12V-5V) S/8.00 S/8.00
SUBTOTAL (ELECTRONICA) S/100.00
6. ESPECIFICACIONES DE MOTORES
Tabla 12. Dimensiones del Polulo Metal Gearmotor 37D mm (131:1) con encoder
(64 CPR) [4].
PROPIEDAD VALOR
Relación de transmisión: 131:1
Velocidad sin carga @ 12V: 80 rpm
Corriente sin carga @ 12V: 300 mA
Bloqueo de corriente a 12V: 5000 mA
Par de torsión a 12V: 250 oz · in (18 kg - m)
Velocidad sin carga @ 6V: 40 rpm10
Corriente sin carga @ 6V: 250 mA10
Bloqueo de corriente @ 6V: 2500 mA10
Par de apriete a 6V: 125 oz · in10 (9 kg - m)
Longitud del cable: 8 in11
9
La medición de longitud no incluye el eje de la caja de engranajes o el área elevada inmediatamente
alrededor de él.
10
Este motor funcionará a 6V pero está diseñado para funcionar a 12 V.
11
Puede variar por unos pocos centímetros.
24
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
Figura 21. Diagrama de dimensiones del Metal Gearmotor Pololu 37D. [4].
25
UNIVERSIDAD NACIONAL DE INGENIERÍA – FACULTAD DE INGENIERÍA MECÁNICA
ANÁLISIS Y CONTROL DE ROBOTS
MANIPULADOR DE 2GDL – INFORME Nº1
7. Bibliografía
[3] POLOLU ROBOTICS & ELECTRONICS, «Pololu Dual VNH5019 Motor Driver Shield for
Arduino,» [En línea]. Available: https://www.pololu.com/product/2507. [Último acceso:
28 Abril 2019].
[4] POLOLU ROBOTICS & ELECTRONICS, «131:1 Metal Gearmotor 37Dx73L mm with 64 CPR
Encoder,» [En línea]. Available: https://www.pololu.com/product/2827. [Último acceso:
28 Abril 2019].
[6] E. EMBAJADORES, «DRIVER 2 MOTORES CONTINUA 2A 30V - L298,» [En línea]. Available:
https://www.electronicaembajadores.com/es/Productos/Detalle/LCMM035/modulos-
electronicos/modulos-driver-controladores-de-motores/driver-2-motores-continua-2a-
30v-l298. [Último acceso: 28 Abril 2019].
26