Documente Academic
Documente Profesional
Documente Cultură
INFORME FINAL
PROFESOR : ING. OLIDEN MARTÍNEZ, JOSÉ
GRUPO :
SECCIÓN : A
2014-I
0
UNIVERSIDAD NACIONAL DE INGENIERIA
DESARROLLO E IMPLEMENTACION DE UN ROBOT CUADRUPEDO DE 12GDL
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.
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á:
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:
4to Avance:
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
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.
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.
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
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.
9no Avance:
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
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.
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
XI.- Bibliografía