Sunteți pe pagina 1din 11

DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

UNIVERSIDAD NACIONAL DE INGENIERÍA


FACULTAD DE INGENIERIA MECÁNICA

INFORME FINAL
PROFESOR : ING. OLIDEN MARTÍNEZ, JOSÉ

GRUPO :

GALLARDO CHÁVEZ, ISAI ANDROX 20091039G

SALCEDO PISCOYA, RICARDO MARTIN 20091008D

ASESOR : ING. VINCES RAMOS, NIKOLAI

CURSO : PROYECTO MECATRÓNICO (MT 818)

SECCIÓN : A

FECHA DE REALIZACIÓN: ../../10

FECHA DE PRESENTACIÓN: ../../10

2014-I

0
UNIVERSIDAD NACIONAL DE INGENIERIA
DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

DESARROLLO DE UN ROBOT CUADRUPEDO DE 12 GDL PARA EXPLORACION


ASISTIDA EN ZONAS DE DIFICIL ACCESO CONTROLADO MEDIANTE UN
DISPOSITIVO MOVIL A TRAVES DE UNA APLICACIÓN ANDROID
Isai Androx Gallardo Chávez (20091039G) Ricardo Martin Salcedo Piscoya (20091008D)
Asesor: Ing. Vinces Ramos, Nikolai
Curso: Proyecto Mecatrónico MT 818 Escuela Profesional: Ingeniería Mecatrónica

I.- Introducción II.- Planteamiento del problema

En la actualidad el diseño de sistema de locomoción de El ser humano es el recurso más importante que se
robots caminantes se ha derivado del estudio de puede tener, muchas veces las tareas que este debe
sistemas biológicos, tomando como principal referente realizar como la exploración implica poner en riesgo
los animales terrestres comunes, en los cuales su su integridad ya que los lugares donde se debe realizar
sistema de locomoción se encuentra basado en un la exploración no son de fácil acceso para este y puede
conjunto de eslabones y articulaciones denominadas presentar peligros ocultos.
patas. Este sistema ha sido diseñado evolutivamente
por la naturaleza de tal manera que hoy se tiene un Para la realización de estas tareas se ha necesitado el
sistema óptimo para desplazamiento sobre terrenos empleo de robots como los UAV o UGV los cuales
irregulares, basado en el apoyo discreto de las patas pueden ingresar a zonas de difícil acceso y pueden
sobre el terreno. tener una mayor percepción de su entorno para los
peligros existentes, pero estos tienen como
Las maquinas caminantes aprovechan este tipo de inconveniente que en zonas donde el terreno es
locomoción, convirtiéndose así en las maquinas irregular tienen problemas para su movimiento.
ideales para espacios de difícil acceso. Estas maquinas
requieren sistemas mecánicos y de control más III.- Justificación
complejos que los usados en sistemas de ruedas. Las
principales características que presentan estas El presente proyecto tiene como fin desarrollar e
maquinas son: implementar un robot móvil cuadrúpedo de 12 grados
de libertad el cual podrá realizar tareas de exploración
 Gran omnidireccionalidad. en zonas de difícil acceso donde los móviles de ruedas
 Capacidad de adaptación al terreno. presentan problemas para desplazarse y los vehículos
 Control de las fuerzas en los puntos de apoyo. voladores no cuentan con suficiente espacio para el
 Apoyos discretos en el terreno. vuelo.

Estas maquinas no son muy empleadas en el ámbito El desarrollo de este robot permitirá a su vez la
nacional ya que sus costos y mantenimiento son más integración de múltiples áreas de conocimientos como
elevados que otros robots, pero a nivel mundial estas es la robótica, sistemas embebidos, control digital y el
maquinas son empleadas como el robot caminante procesamiento de señales, las cuales son materias de
SILO 6 que se muestra en la Fig. 1, desarrollado para gran uso y esenciales a lo largo de la carrera de
la detección de minas personales Ingeniería Mecatronica.

También este proyecto permitirá realizar un estudio


sobre la locomoción de estos sistemas la cual podrá ser
empleada como estado del arte para futuros proyectos
sobre robots caminantes permitiendo tener
información sobre el comportamiento cinemático de
estos.

IV.- Aplicaciones prácticas

Entres las múltiples aplicaciones que presentan estos


robots caminantes tenemos:

Figura 1. Robot SILO 6.  Detección de minas personales, mediante la


localización de estas se evitara pérdidas
humanas.
 Trabajos de forestación, donde el móvil podrá
desplazarse por zonas montañosas o rocosas

UNIVERSIDAD NACIONAL DE INGENIERIA 1


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

plantando semillas donde un ser humano no encargara de ejecutarlas mediante el control de PWM
podría acceder como en zonas de gran pendiente. hacia los servomotores del robot para su locomoción.
 Limpieza de fachadas, para ello el móvil tendrá
que mantenerse en una posición vertical Para lograr una adecuada implementación del robot se
convirtiéndose en un robot escalador esto evitara deberá tener en cuenta el uso de materiales de
poner en riesgo a personas en tareas de limpieza características idénticas o similares en cada pata del
de edificios de gran altura. robot para permitir un modelamiento adecuado del
 Transporte de equipos y herramientas de sistema en general como es el torque de los
construcción, muchas veces las construcciones servomotores, a su vez por fines prácticos la estructura
requieren obreros en zonas donde necesitan tener mecánica solo contara con los requerimientos mínimos
ambas manos libres para poder sujetarse y llevar para su funcionamiento, esto evitara un alto costo en la
herramientas en su cinturón podría hacer que este implementación.
se enrede con los cables, por ello estos móviles
permitirán realizar el transporte de estas. Entre las aplicaciones prácticas del robot se tendrá:

V.- Objetivos  Exploración asistida en zonas de acceso limitado.


 Transporte de sustancias toxicas o residuos
 Objetivos Generales: peligrosos.
 Modelo educativo para estudios de locomoción
 Desarrollar un robot cuadrúpedo de 12 GDL de robots cuadrúpedos.
que pueda ser controlado por un dispositivo
móvil a través de una aplicación Android. Entre las futuras mejoras que se podrían realizar se
tendrá:
 Objetivos Específicos:
 Implementación de sensores para la localización
 Diseñar e implementar la estructura mecánica de objetos y obstáculos.
y electrónica necesaria para el robot.  Aumento de la robustez de la estructura mecánica
 Modelar la locomoción del robot (caminar – para el transporte de materiales.
girar – ascender – descender).  Implementación de un dispensador de semillas
 Programar en un sistema embebido el control para aplicaciones de forestación en terrenos
de la locomoción del robot. desforestados.
 Diseñar y programar una aplicación en
Android para la comunicación del dispositivo VII.- Cronograma semanal de trabajo
móvil con el robot cuadrúpedo.
En la Tabla 1 se presentan las actividades semanales
VI.- Características del producto final que han sido realizadas para el desarrollo del proyecto
en un tiempo de 12 semanas, contando la semana 0
Se tendrá tanto un diseño de hardware como de fuera del cronograma.
software del robot donde se especificaran para el caso
del hardware los análisis realizados para la selección
de los actuadores así como de la estructura, a su vez se Semana Actividad
tendrán los planos del diseño. Esta estructura contara Estudio del estado del arte.
con la superficie adecuada para el montaje del sistema
Semana 0 Determinación de las características
embebido así como del móvil con sistema operativo
de la estructura mecánica.
Android.
Diseño en Solidworks de la
estructura mecánica.
En la parte de software se tendrá el programa de Semana 1
Selección de materiales y actuadores
control que será implementado en un sistema
en base al diseño en Solidworks.
embebido, este programa permitirá realizar las
funciones básicas de la locomoción del robot que serán Adquisición de materiales y
Semana 2
enviadas a través de una aplicación Android de un actuadores
dispositivo móvil. Desde este se enviara los comandos Construcción de la estructura
Semana 3
de la locomoción del robot que son desplazamiento mecánica.
hacia la derecha, izquierda, adelante, atrás, arriba, Estudio de la locomoción del robot
Semana 4
abajo y giro; así como también comandos de control cuadrúpedo.
como son encendido, apagado. Modelamiento de la locomoción del
Semana 5
robot cuadrúpedo.
La aplicación enviara las órdenes desde el dispositivo Simulación de trayectoria de
Semana 6
móvil a través de Bluetooth hacia el sistema embebido, locomoción de robot cuadrúpedo.
que se encontrara en la estructura del robot, que se

UNIVERSIDAD NACIONAL DE INGENIERIA 2


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

Diseño de la interfaz gráfica,


ventanas y comandos usados para el
Semana 7 movimiento.
Ensamblaje final de la estructura
mecánica.
Selección el módulo bluetooh a usar,
estudio de la comunicación e
Semana 8 Figura 3. Soporte para servomotores.
identificación de requerimientos para
la realización.
Programación de la interfaz para
Semana 9 dispositivos con Android, prueba de
interfaz.
Selección del sistema embebido a
usar, programación de rutinas de
Semana 10 movimiento del robot cuadrúpedo.
Selección del dispositivo Android Figura 4. Brackets para servomotores.
requerido para la aplicación.
Construcción de la etapa electrónica
Semana 11 y distribución de señales para el
funcionamiento.
Prueba de funcionamiento de
Semana 12 comunicación y locomoción del
robot cuadrúpedo. Figura 5. Base del robot cuadrúpedo.
Tabla 1: Cronograma de actividades semanal.
Los puntos de contacto del robot que se aprecian en la
Fig.6., muestran una superficie de redondeo, esto
VIII.- Descripción de avances según el cronograma evitara que se puede tener accidentes al maniobrarlo.
1er Avance:

Se diseñó la estructura mecánica mediante el uso del


Solidworks dimensionando las piezas reales para tener
una mayor fiabilidad del diseño.

En la Fig.2, se puede ver la vista tridimensional de Figura 6. Pata de soporte del robot cuadrúpedo.
robot, este constara de 12 GDL que serán distribuidos
en 3 GDL por pata. Se escogieron para el movimiento servomotores
Tower Pro MG995, los cuales presentan un torque
máximo de 15 kg permitiendo de esta manera que toda
la estructura pueda moverse.

2do Avance:

Se realizó la compra de los brackets y soportes para


servomotores, así como la compra de los
servomotores, para lo cual se realizó una importación
debido a que no estaban la cantidad requerida en stock,
el tiempo de llegada es de 30 días.

En la Tabla 2 se detalla el importe de compra de los


distintos componentes.
Figura 2. Vista tridimensional del robot.

La estructura fue diseñada tomando el uso de soportes,


Fig.3, y brackets, Fig.4, diseñados especialmente para
servomotores, los cuales están hechos de aluminio así
como la base del robot, Fig.5.

UNIVERSIDAD NACIONAL DE INGENIERIA 3


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

Materiales Precio (S/.)


1 Laptop ---
Estructura mecánica 400
12 servomotores 480
Fuente de energía DC 12V 10
Sistema embebido --- Figura 9. Diagrama de locomoción 1.
Componentes electrónicos 60
diversos T1: En el tiempo uno, las cuatro piernas
Dispositivo con Android ---- (extremidades) se encuentran en el suelo.
Tabla 2: Lista de materiales con precios asignados. T2: El segundo tiempo es mover I1 mientras que las
Los materiales que no presenten precio serán tomados demás están en el suelo.
en calidad de préstamo. T3: I2 está en el aire mientras I1, D1 y D2 se
encuentran en el suelo
3er Avance:
 Locomoción 2 (Tortuga)
Se construyó la estructura mecánica de dos patas del
robot para pruebas de movimiento, en la construcción Consiste en mantener en todo momento dos piernas del
de estas se requirió el uso de rodamientos especiales robot en el suelo mientras las otras dos están en
los cuales facilitan el movimiento Fig.7. movimiento. La desventaja de este es que llega a ser
inestable, ya que el área de apoyo se reduce a una línea,
la forman las piernas de apoyo. La ventaja es que su
velocidad de locomoción es mayor, ya que mueve dos
piernas a su vez Fig. 10.

Figura 7. Pata del robot cuadrúpedo.

4to Avance:

Se realizó el estudio de la locomoción del movimiento


del robot, se tuvo en consideración que para el Figura 10. Robot apoyo dos piernas.
movimiento de este se debería tener en cuenta las
semejanzas con el movimiento de animales que Este tipo de locomoción presenta el siguiente diagrama
presenten esta locomoción. en la Fig. 11.
 Locomoción 1:

Se coloca en todo momento el centro de masa del robot


sobre el triángulo de apoyo formado por los tres pies
en contacto con el suelo, mientras el otro pie esta en
movimiento. Este tipo de caminado es del elefante Fig.
8. Las ventajas que tiene este tipo de configuración es Figura 11. Diagrama de locomoción 2.
que nunca perderá el equilibrio ya que el centro de
gravedad se encuentra dentro del área de apoyo; una T1: El tiempo uno, las cuatro piernas (extremidades)
desventaja, es muy lento en su locomoción. se encuentran en el suelo.
T2: El segundo se mueve I1 y D2, mientras que I2 y
D1 están en el suelo.
T3: I2 y D1 están en el aire, mientras I1 y D2 se
encuentran en el suelo.

5to Avance:

Figura 8. Robot apoyo tres piernas. Se realizó el modelamiento cinemático del robot
cuadrúpedo, para ello se empleó el algoritmo Denavit
Este tipo de locomoción presenta el siguiente diagrama – Hartenberg.
en la Fig. 9.
En el modelamiento se analizó la configuración de una
pata del robot tomando como punto fijo el servomotor
que se encuentra sobre la base y que cada pata, como
se puede ver en la Fig. 12. Este modelamiento se

UNIVERSIDAD NACIONAL DE INGENIERIA 4


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

asemeja a considerar cada pata como un brazo robótico 𝑷𝑿 = ⁡𝑳𝟏 ∗ 𝒄𝒐𝒔(𝒒𝟏) + ⁡𝑳𝟐 ∗ 𝒄𝒐𝒔(𝒒𝟏) ∗ 𝒄𝒐𝒔(𝒒𝟐)
de 3 GDL. + ⁡𝑳𝟑 ∗ 𝒄𝒐𝒔(𝒒𝟏) ∗ 𝒄𝒐𝒔(𝒒𝟐)
∗ 𝒄𝒐𝒔(𝒒𝟑) − ⁡𝑳𝟑 ∗ 𝒄𝒐𝒔(𝒒𝟏)
∗ 𝒔𝒊𝒏(𝒒𝟐) ∗ 𝒔𝒊𝒏(𝒒𝟑) … (𝟏)

𝑷𝒀 = 𝑳𝟏 ∗ 𝒔𝒊𝒏(𝒒𝟏) + ⁡𝑳𝟐 ∗ 𝒄𝒐𝒔(𝒒𝟐) ∗ 𝒔𝒊𝒏(𝒒𝟏)


+ ⁡𝑳𝟑 ∗ 𝒄𝒐𝒔(𝒒𝟐) ∗ 𝒄𝒐𝒔(𝒒𝟑)
∗ 𝒔𝒊𝒏(𝒒𝟏) − ⁡𝑳𝟑 ∗ 𝒔𝒊𝒏(𝒒𝟏)
∗ 𝒔𝒊𝒏(𝒒𝟐) ∗ 𝒔𝒊𝒏(𝒒𝟑) … (𝟐)

𝑷𝒁 = 𝑳𝟐 ∗ 𝒔𝒊𝒏(𝒒𝟐) + ⁡𝑳𝟑 ∗ 𝒄𝒐𝒔(𝒒𝟐) ∗ 𝒔𝒊𝒏(𝒒𝟑)


+ ⁡𝑳𝟑 ∗ 𝒄𝒐𝒔(𝒒𝟑) ∗ 𝒔𝒊𝒏(𝒒𝟐) … (𝟑)

Figura 12. Ejes para algoritmo D-H. Mediante estas ecuaciones se elaboraron los scripts en
Matlab para poder simular los movimientos de las
En esta configuración se puede apreciar que cada pata articulaciones ploteando el robot como se ve en la Fig.
presenta 3 articulaciones rotacionales, cuyas variables 13.
de articulación se presentan en la Tabla 3.

Articulación Variables
1 q1
2 q2
3 q3
Tabla 3: Variables de cada articulación.

Se cálculos los parámetros D-H los cuales se presentan


en la Tabla 4.

Articulación a α d θ
1 L1 90° 0 q1
2 L2 0° 0 q2 Figura 13. Plot del robot cuadrúpedo.
3 L3 0° 0 q3
Tabla 4: Parámetros D-H. Esta simulación mantiene la base estática del
movimiento de las patas mediante el ingreso de
Se calculó las matrices de transformación de posición parámetros qi, donde i=1:12
para cada eslabón.
6to Avance:
𝐜𝐨𝐬⁡(𝒒𝟏) 𝟎 𝐬𝐢𝐧⁡(𝒒𝟏) 𝑳𝟏𝒄𝒐𝒔(𝒒𝟏)
𝐬𝐢𝐧⁡(𝒒𝟏) 𝟎 −𝐜𝐨𝐬⁡(𝒒𝟏) 𝑳𝟏𝐬𝐢𝐧⁡(𝒒𝟏) La simulación del robot se siguió bajo la configuración
𝑻𝟏𝟎 = [ ] de la Fig.14., donde se aprecia una caminata hacia
𝟎 𝟏 𝟎 𝟎
𝟎 𝟎 𝟎 𝟏 adelante.

𝐜𝐨𝐬⁡(𝒒𝟐) −𝐬𝐢𝐧⁡(𝒒𝟐) 𝟎 𝑳𝟐𝒄𝒐𝒔(𝒒𝟐)


𝐬𝐢𝐧⁡(𝒒𝟐) 𝐜𝐨𝐬⁡(𝒒𝟐) 𝟎 𝑳𝟐𝒔𝒊𝒏(𝒒𝟐)
𝑻𝟐𝟏 = [ ]
𝟎 𝟎 𝟏 𝟎
𝟎 𝟎 𝟏 𝟎

𝐜𝐨𝐬⁡(𝒒𝟑) −𝐬𝐢𝐧⁡(𝒒𝟑) 𝟎 𝑳𝟑𝒄𝒐𝒔(𝒒𝟑)


𝐬𝐢𝐧⁡(𝒒𝟑) 𝐜𝐨𝐬⁡(𝒒𝟑) 𝟎 𝑳𝟑𝒔𝒊𝒏(𝒒𝟑)
𝑻𝟑𝟐 =[ ]
𝟎 𝟎 𝟏 𝟎
𝟎 𝟎 𝟎 𝟏

Se calculó la posición final del eslabón teniendo las


siguientes ecuaciones (1), (2) y (3) para una
orientación tridimensional de la cinemática directa: Figura 14. Caminata hacia adelante. Variable d: en
el suelo, u: en el aire.

Para la caminata hacia atrás, izquierda y derecha se


configura según la Tabla 5.

UNIVERSIDAD NACIONAL DE INGENIERIA 5


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

Adelante Atrás Derecha Izquierda


1 4 4 2
2 3 1 3
3 2 3 1
4 1 2 4
Tabla 5: Configuración de patas para movimiento.
7mo Avance:

Se diseñó la interfaz gráfica mediante el uso de la


plataforma MIT App Inventor 2, tal que cuente con las
ventanas presentación, seguridad y controles, las
cuales se detallaran de la siguiente manera:

i. Ventana Presentación:
Figura 16. Ventana de seguridad.
Presenta la caratula del curso donde se puede
información del proyecto y autores ver Fig. 15. Esta ventana cuenta con los botones de ingreso
numérico y los botones de funcionamiento Validad y
Borrar, cuyo funcionamiento se detalla en la Tabla 7.

Botón Función
Comprueba el código
ingresado y habilita la
Validar ventana de control y
deshabilitando la
ventana de seguridad.
Borra los caracteres
Borrar
ingresados.
Tabla 7: Especificaciones de botones ventana
seguridad

iii. Ventana Control:

Presenta los comandos de control del robot, ver Fig.


Figura 15. Ventana de presentación. 17., con los botones Encendido, Apagado y Salir cuyas
funciones se especifican en la Tabla 8.
Esta ventana cuenta con los botones Salir y Siguiente,
cuyas funciones se especifican en la Tabla 6.

Botón Función
Salir Cierra la aplicación
Deshabilita la ventana
Siguiente presentación y habilita
la ventana seguridad.
Tabla 6: Funciones de botones de ventana
presentación.

ii. Ventana Seguridad:

Habilita el ingreso del código de seguridad requerido


para la activación de la ventana de control, se Figura 17. Ventana de control.
implementó como medida de seguridad para privatizar
el control del robot, ver Fig.16. Botón Función
Habilita la sub ventana
de controles
Encendido
encendiendo el robot en
una posición inicial.
Deshabilita la sub
Apagado
ventana de controles

UNIVERSIDAD NACIONAL DE INGENIERIA 6


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

llevando al robot a una


posición de reposo. Para la comunicación del módulo bluetooh con la
Salir Cierra la aplicación. interfaz en el dispositivo Android se hizo necesaria la
Tabla 8: Funciones de botones de ventana control. identificación de la MAC de este, para ello se energizo
el modulo usando un Arduino Uno, ya que necesita un
La sub ventana de controles permite la realización de voltaje VCC de 3.3v, y con la aplicación Amarino la
las diferentes locomociones presentes en el robot, estas cual nos permitió identificar el valor siguiente
han sido divididas en movimientos y posiciones, ver 20:14:03:27:42:60. A su vez este módulo presenta una
Fig. 18. clave 1234 y una velocidad de transmisión de 9600
baudios, este dato es importante ya que permitirá
configurar la comunicación en el sistema embebido.

9no Avance:

La programación de la aplicación se realizó mediante


bloques usados en la plataforma MIT App Inventor 2,
cuyo diagrama se aprecia en la Fig. 21.

Figura 18. Sub ventana de controles de locomoción.

Se ensamblo la estructura final del robot, ver Fig. 19.,


se hicieron cambios respecto al diseño inicial en las
uniones y patas de apoyo cambiando el material de
aluminio a un material de tablero de fibra de densidad
media (MDF) por presentar un menor peso y menor
costo.

Figura 21. Diagrama de bloques de configuración de


la aplicación.

La programación de bloques mostrada se puede dividir


en 3 sub bloques:

Figura 19.. Estructura mecánica finalizada. i. Bloque ventana presentación:

8vo Avance: Las funciones de los botones son configuradas


mediante los siguientes bloques para la habilitación de
Se seleccionó el módulo bluetooh HC-06, ver Fig.20., ventanas, ver Fig. 22.
para realizar la comunicación entre el dispositivo
Android y el sistema embebido a programar, este
módulo es de tipo esclavo por lo que permitirá
conectarlo con una pc, celular o tablet.

Figura 22. Configuración de botones mediante evento


click.
Figura 20. Módulo bluetooh HC-06.
ii. Bloque ventana seguridad:
Se consideró también el HC-05 el cual permite realizar
Se realiza la validación de la clave de seguridad
la conexión entre dispositivos bluetooh que estén
comparándola con una clave existente en la memoria
unidos a sistemas embebidos pero por su alto costo y
de la aplicación, ver Fig. 23.
función de maestro-esclavo se eligió el HC-06.

UNIVERSIDAD NACIONAL DE INGENIERIA 7


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

Se seleccionó la placa de Arduino Due como sistema


embebido encargado de ejecutar las señales de control,
esto se basó en las características que este posee, ver
Fig 25.

Figura 23. Configuración de botones de clave de


seguridad mediante evento click. Figura 25. Características del Arduino Due.

iii. Bloque ventana control: Se escogió esta placa especialmente por la


característica de poseer 12 PWM que pueden ser
Se muestran las funciones de bloques para realizar las usados simultáneamente lo cual coincide con el
funciones del botones Encendido y Apagado, ver requerimiento de movimiento de 12 articulaciones a la
Fig.24.; además de la habilitación del bluetooh y de los vez. Se comprobó mediante pruebas que la señal de
string enviados por comandos especificados en Tabla control de 3.3v es suficiente para el control de los
9. servomotores por lo cual no se decidió implementar
una interfaz de 3.3v a 5v.

Para la programación de las rutinas de locomoción se


siguió la siguiente configuración, ver Fig. XX.,
empleando las librerías proporcionadas para Arduino
Due.

Figura 24. Configuración de controles mediante


evento click.

String Comando
0AB Posición inicial Figura 26. Configuración inicial para distintas
1AR Movimiento adelante locomociones dependientes del string enviado.
1AB Movimiento atrás
1DE Movimiento derecha El principio de operación es leer el dato enviado por el
1IZ Movimiento izquierda dispositivo Android mediante bluetooh al Arduino
1DO Movimiento abajo Due, este valor será leído para poder identificar la
1UP Movimiento arriba rutina de ejecución, por ultimo al finalizar la ejecución
1GI Giro a la derecha del comando se borra lo leído en el puerto serial y
1GD Giro a la izquierda vuelve al loop para buscar otro comando.
Tabla 9. String para activación de comandos.
Para la selección del dispositivo Android se seleccionó
10mo Avance: una tablet debido a que es un dispositivo de gran uso y
de fácil acceso, además de presentar una pantalla más
amplia para la visualización de los distintos botones de

UNIVERSIDAD NACIONAL DE INGENIERIA 8


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

comandos que en un celular muchas veces no son de 18A a un voltaje de 5v que es el necesario para la
simples de diferenciar. energización de los servomotores.

11vo Avance: IX.- Informe económico final

Para la implementación de la electrónica se vio Se elaboró el informe económico final del proyecto
necesaria la construcción de una placa encargada de la considerando los elementos de costo fijo y los
distribución de la señal y alimentación a los elementos de costo cero, tomados en préstamo como
servomotores, ver Fig. 27., esta placa deberá ser se detalla en la Tabla 10.
montada sobre la estructura del Arduino Due para
ahorro de espacio. Material Precio (S/.)
12 Servomotores 480
Juegos de brackets 180
Tornillos 20
Arandelas 5
Estructura MDF 15
Elementos
20
electrónicos
Fuente de energía 15
Módulo bluetooh 15
Arduino Due ---
Laptop ---
Total 730
Tabla 10: Lista de componentes y precios asignados,
Figura 27. Placa de distribución de energía y señales los elementos tomados en cuestión de préstamos
de control para servomotores. presentan costo 0.

Esta placa deberá conducir un alto amperaje para los X.- Conclusiones
servomotores por lo cual la alimentación por la
bornera en con doble cable trenzado, manteniendo el (1) El modelamiento de las patas del robot
aislamiento adecuado para evitar accidentes. cuadrúpedo como un brazo robótico de 3
GDL permite realizar el cálculo de la
No se requirió la implementación de una interfaz cinemática directa del robot para las
electrónica de 3.3v a 5v debido a que se comprobó simulaciones de movimiento.
que la señal del Arduino Due podía energizar los (2) Las condiciones de restricción para cada
servomotores adecuadamente. grado de libertad permite evitar problemas en
la implementación del robot como choques en
12vo Avance: la estructura.
(3) La estructura mecánica se ha diseñado
Para la etapa de pruebas del robot se consideró el intentando aligerándola, solo considerando
siguiente esquema de trabajo, ver Fig. 28. las estructuras importantes para evitar un
sobrepeso en el robot que afectaría el
desempeño de los motores.
(4) El tipo de locomoción escogido permite que
el robot mantenga su equilibrio manteniendo
su centro de gravedad dentro del triángulo de
apoyo.
(5) El uso de trayectorias establecidas para la
locomoción dependiendo del comando
recibido permite realizar movimientos con
mayor precisión pero limitando a la vez su
desplazamiento.
(6) La plataforma MIT App Inventor 2, para
Figura 28. Esquema de conexión de energización del programación de aplicaciones en dispositivos
robot. Android, para el movimiento de trayectorias
predefinidas del robot presenta una gran
Como se ve en la figura anterior se hizo necesario el ayuda ya que cuenta con funciones
uso de una fuente de computadora para la alimentación empaquetadas en bloques permitiendo un
debido a que el consumo de amperaje supero los 8A, ahorro de tiempo en la programación.
siendo la máxima entrega de amperaje de esta fuente

UNIVERSIDAD NACIONAL DE INGENIERIA 9


DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL

(7) La comunicación vía bluetooh mediante el


dispositivo HC-06 presenta problemas en
grandes distancias debido a que pierde la
conexión entre el dispositivo y el modulo,
pero para cuestiones de elaboración de
prototipo es de bajo costo en comparación a
otros módulos existentes en el mercado de
funciones similares.
(8) El Arduino Due a pesar de la ventaja de
contar con 12 PWM presenta problemas en la
energización de los 12 servomotores, como se
comprobó en las pruebas realizadas solo se
llegó al funcionamiento de 11 de ellos, una
forma de solucionar este inconveniente es
mediante el multiplexado de las señales de
control para evitar la saturación.
(9) La señal de salida de control del Arduino Due
es de 3.3v la cual es suficiente para los
servomotores Tower Pro MG995 sin la
necesidad de una implementación de una
interfaz de conversión de 3.3v a 5v.
(10) El consumo de corriente de los servomotores
es alta, en pruebas en vacío se determinó un
consumo aproximado máximo de 3A por
pata, por lo cual se empleó, para pruebas, una
fuente de computadora la cual a régimen de
alimentación de 5v llega a entregar un
máximo de 18A.

XI.- Bibliografía

[1] “Diseño e Implementación de un Robot Móvil


Cuadrúpedo”. E. Calle, I. Ávila, J. Zambrano.
Universidad Politécnica Salesiana
[2] “Locomoción de un Robot Cuadrúpedo: Un
Enfoque a Celdas Neurológicas Analógicas”.
Elizabeth Sedeño Bustos. Centro de Investigación y
Desarrollo Tecnológico.
[3] “Diseño, Construcción y Control de un Robot
Cuadrúpedo con Actuadores de Alto Desempeño
Conectados a Red”. Bautista Quintero Ricardo,
Aguirre Cerrillo Fabio Abel, Ramos Andrade José
Alfredo, Chavira Gutiérrez Diego Enrique, López
Cabrera Ramón Jovani. Instituto Tecnológico de
Culiacán.
[4] “Creando una aplicación con App Inventor”.
http://www.proyectosarduino.com.ar/creando-una-
aplicacion-con-app-inventor/ (11/06/2014).
[5] “Modulo Bluetooh HC-06”.
http://electgpl.blogspot.com/2013/01/modulo-
bluetooth-hc-06.html (05/06/2014).
[6] “Arduino Due”.
http://arduino.cc/en/Main/arduinoBoardDue
(28/06/2014).

UNIVERSIDAD NACIONAL DE INGENIERIA 10

S-ar putea să vă placă și